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PREFACE 


This report was prepared by Green Mountain Radio Research Company, Bur- 
lington, Vermont, under contract NAS8-34960 from the NASA George C. Marshall 
Space Flight Center. The work upon which it is based was done by the author 
between September 1982 and June 1983, inclusive. The contracting officer's 
representatives were James A. Dunkin, James D. Michael, and R. Sharma. The 
manuscript and artwork were prepared by Patricia L. Scott. 
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CHAPTER 1 


INTRODUCTION 


The reusable Space Transportation System (STS, "Shuttle"), the Tele- 
operator Maneuvering System (TMS), and Orbital Transfer Vehicle (OTV) will be 
required routinely to rendezvous and to dock with other spacecraft, including 
satellites, experiment platforms, and the Space Operations Center (SOC, space 
station). Rendezvous requires measurement of relative position and velocity, 
and suitable information can be provided by radar. In contrast, docking in- 
volves alignment (and therefore measurement) of both relative position and 
relative attitude (Figure 1-1). 

Rendezvous and docking can be accomplished by manual guidance commands 
based upon radar and visual inputs. However, the required workload is rela- 
tively high and docking may require alignment of interfaces that are not 
readily visible. Visual sensing and manual control is obviously unsuitable 
for remote and automatic spacecraft guidance. Consequently, a relati ve-posi- 
tion-and-attitude sensor is needed. 

Spacecraft such as the STS and TMS are "active" and can maneuver to ac- 
complish rendezvous and docking. However, the target spacecraft is of^pn un- 
able to maneuver and is therefore designated ac "passive." It is reasonable 
to assume that the active spacecraft can carry an active, sophisticated sen- 
sor. However, the passive spacecraft may have little or no power or space 
available for the sensor. It is therefore highly desirable to minimize the 
complexity and power requirements of the system for the passive spacecraft. 

The polarized interferometer is a radio-frequency system for real-time, 
long-range measurement of the relative position and attitude of two space- 
craft. Both spacecraft are equipped with a multi -element antenna array and 
a transponder. The transponder on the active spacecraft measures signal 
parameters and processes them to obtain position and attitude estimates for 
use by the guidance system. The transponder on the passive spacecraft is a 
simple repeater. 


1.1 PRINCIPLES OF OPERATION 


The polarized-interferometer is based upon three basic principles: 

• The use of round-trip timing to determine range, 

• The use of interferometry to determine direction of arrival, and 

• The use of polarization to determine rotation. 

The specific uses of each of these three principles are explained in this 
section; the relevant mathematics are presented in the subsequent chapters. 

The operation of the polarized interferometer is most readily described 
in the "two-way" coordinate system shown in Figure 1-2. In the "one-way" 
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Figure 1 - 2 . Two-way coordinate system. 


coordinate frame of Figure 1-1, the position of the passive spacecraft with 
respect to the active spacecraft is specified by range, azimuth, and eleva- 
tion (p, a , g ); attitude is specified by a set of three Euler angles (4 , 

1 l 3 

V, , i' ). In the two-way coordinate system, the position of the passive 

spacecraft is similarly specified. However, the two-way coordinate system 
specifies position (p, a , u^) of the active spacecraft with respect to the 

passive spacecraft and the relative-roll angle ( 4 ^) between the two space- 
craft coordinate frames instead of attitude. 

A typical antenna array for the active spacecraft is shown in Figure 
1-3. Each of the four components consists of two crossed slots or two 
crossed dipoles. Component AO is used for transmitting and is configured to 
produce linear polarization. Components Al, A2, and A3 are used for receiv- 
ing. Component Al is configured for linear polarization, while A2 and A3 are 
configured for circular polarization. 

The antenna array for the passive spacecraft is similar to that for the 
active spacecraft, but the roles of the components are reversed. Center com- 
ponent PO is used for reception, and outer components PI, P2, and P3 are used 
for transmitting. 

Range is determined by round-trip signal timing. Accurate and unambigu- 
ous measurements can be achieved by transmitting CW signals on a number of 
frequencies or by employing short-pulse or spread-spectrum modulation. 

The direction of the passive spacecraft with 'espect to the active 
spacecraft is determined by radio interferometry . The signa 1 from a given 
component of the passi ve-spacecraft antenna array is received by components 
Al, A?, and A3 of the active-spacecraft array. T he phases of the output from 
each antenna component are measured and compared; the differences between the 
phases are directly proportional to the differences in the three path lengths 
(Figure 1-3). Since the three paths are essentially parallel except at very 
short distances, the phase differences can be converted to direction angles 

a and £ . 

1 1 

Interferometric techniques are similarly used to determine the direction 
of arrival of the active spacecraft with respect to the passive spacecraft. 
Since the complexity of the transponder on the passive spacecraft must be 
minimized, all measurements, reverse direction finding is accomplished by 
comparing the phases of signals from elements PI, P2, and P3 as received by 
the same element (e.g., Al) of the active-spacecraft array. These phase dif- 
ferences are similarly converted to reverse-direction angles a and 8 . 

z z 

The relative-roll angle is determined from measurements of the polari- 
zation of the received signals. Component PI transmits sequentially using 
both linear polarizations. Measurement of the amplitudes of each signal by 
the two elements of component Al results in a set of four coupling measure- 
ments. If all four direction angles were zero, each of the four coupling 
measurements would be directly proportional to the sine or cosine of the rel- 
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ative-roll angle. While the mathematics are somewhat more complicated when 
the direction angles are nonzero, the relative-roll angle can nonetheless be 
extracted from the coupling measurements once the direction angles have been 
determined. 


1.2 PERFORMANCE REQUIREMENTS 


Potential applications for rendezvous and docking (R&D) sensors include 
the Space Shuttle (STS), the Teleoperator Maneuvering System (TMS), the Or- 
bital Transfer Vehicle (OTV), and the Space Operations Center (SOC). Mis- 
sions may be divided into rendezvous, station-keeping, and docking [Micheal, 
1981]. The docking phase (range less than 30 m) has the most critical per- 
formance reoui rements. 

Anticipated performance requirements are cited by a number of authors. 
The most recent and most thorough investigation is that of Laurie [1982], 
whose results are summarized in Table 1-1. The maximum required operating 
range of 50 km is the result of the availability of the STS radar and the an- 
ticipated availability of NAVSTAR/GPS navigation. 

The Laurie concept uses a set of reflectors with a 1-m diameter. Simi- 
lar-sized arrays on the target spacecraft are also envisioned by Tietz [1982] 
and Dabney [1981], A sensor diameter of up to 1 meter therefore appears to 
be acceptable. 


1.3 OTHER APPROACHES 


Literature related to rendezvous and docking sensors was 
establish typical system performance parameters and to obtain 
nation on alternative approaches. The results are summarized 
ti on. 


reviewed to 
general infor- 
in this sec- 


RF Techniques 

A variety of RF position and attitude sensors are discussed by Lowry 
[1967], These sensors include conventional radar, rotating beacons (similar 
to VOR or TACAN), transponders, and passive reflectors. 


Scanning Laser Radar 

The scanni ng-1 aser-radar system [Flom, 1974-1975] derives position and 
attitude from a set of range *nd angle measurements to a number of reflectors 
on the target spacecraft. T.tis system has a maximum range of about 50 km, a 
range accuracy cf 10 cm or 0.01 percent of range (3o), an angular accuracy 
of 0.05°, and a 30° * 30° field of view. 
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Apo 1 lo Automatic Pocking Sensor 

An automatic-docking-sensor concept for the Apollo spacecraft is devel- 
oped by Blanchard [1971]. In this concept, a number (at least four) of re- 
flectors or light sources are affixed to the target spacecraft, in a known 
geometry. The angles to these reflectors or sources are then measured by an 
optical system (probably using a vidicon). The position and attitude of the 
target spacecraft are then derived from the set of angle measurements . 


Radar and Televi si on 

A Space-Shuttle proximity-operation sense concept was studied by 
Weber [1978], The STS Ku-band radar is satisfactory for acquisition and 
long-range use. However, at short range (when the target occupies 10 " or 
more of the 3-dB beamwidth), the Ku-band radar is not accurate. Increasing 
the accuracy is not feasible because the monopulse antenna patterns cannot be 
predicted at short ranges. Weber's proposed solution slaves a television 
camera to the radar line of sight and mixes the angle measurements from all 
sensors. His simulations show that together they provide satisfactory accu- 
racy. 


Soviet Rendezvous Sy s t em 

An automatic rendezvous system used by the U.S.S.R. is described in gen- 
eral by legostaev [ 1%8] and Laurie [1982]. This system employs a radar on 
the chase spacecraft and a transponder beacon on the target spacecraft. Both 
spacecraft align themselves to the line of sight to the other spacecraft, 
thereby cancel lino position-angle errors and two of the three attitude-angle 
errors. A supplementary sensor for roll-angle sensing is mentioned but not 
described. It should be noted that this system does not allow automatic ren- 
dezvous and docking with a passive or disabled spacecraft, since both space- 
craft must have maneuvering capability. 


Laser-Pi ode Radar 

The RHP sensor concept developed by Laurie [1982] uses a laser-diode 
system to measure the ranges and angles to a set of three reflectors on the 
passive spacecraft. This concept is in general similar to that of Flom and 
Coombies Lld/4-10/5], but uses more modern hardware. 

The three reflectors a^e placed on a circle with a 1-n diameter. The 
laser-diode transmitter employs intensity modulation and electronic beam 
steering. Range is derived from the phase of the "tone" that modulates the 
transmitted signal. The receiver employs an image dissector, photomulti- 
plier, and beam steering (for angle-of-arrival measurement). 

The predicted range-measurement accuracy of this system is 15 mm (3o) at 
ranges of 2 to 100 m, and 0.015 % of range thereafter. The corresponding 
ranee-rate accuracies are 0.01 and 0.1 m/s, respectively. The angle and 
angle-rate measurement accuracies are predicted to be 1.2 mrad (0.07°) and 
0.1 mrad/s (0.00b 1 ’), respectively. The system is designed to comply with the 
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requirements given in Table 1-1. 


Ring of Lights 

Dabney [1981] describes an RAD sensor based upon a ring of lights in- 
stalled upon the target spacecraft. As viewed from the active spacecraft, 
the ring of lights forms an ellipse whose size, shape, and orientation de- 
pend upon the its position and attitude relative to the observer. A curve- 
fitting algorithm is used to extract position and attitude information from 
the observed image of the ring. 

This system has a useful range of 3.2 m to 75 m; operation at shorter 
ranges is possible if the camera lens can be changed automatically to allow 
a larger field of view. Alternatively, a second, smaller ring of lights 
could be used. As the two spacecrafts become aligned, the symmetry of the 
pattern causes the roll angle to become indeterminate. However, this is not. 
regarded as a serious problem and can easily be overcome by adding a light. 


Three-light Video System 

An RAD sensor based upon a three-light array on the passive spacecraft 
is analyzed by Tietz and Kelly [1982]. Their analysis includes a simulation 
with a Kalman-fi Iter estimator. 

Individual lights must be identified; this can be accomplished by blink- 
ing upon radio command or by color. The light array weighs only 5 kg and has 
a volume of 0.02 m J . The maximum linear dimension of this array appears to 
be about. 1 m. 

Updated estimates are p r ovided at a 10-Hz rate. The accuracy is 3 % of 
range at 20 m and 47 percent of range at the maximum range of 300 m. 

Relative position and attitude can also be measured by a technique based 
upon quasi-static (near-field) magnetic-dipole field patterns [Raab, 197°. 
1981]. In this approach, a three-axis transmitter is placed on one space- 
craft and a three-axis receiver is placed on the other spacecraft. The power 
requirements of this syslem limit its potential use to relatively short 
ranges (e.g., s 1 km). In addition, extensive calibration of the field pat- 
terns is required to compensate for the effects of the spacecraft. 

In the late 1980s, the NAVSTAR Global Positioning System [Parkinson, 
1^80] will become operational. Precise position information will be avail- 
able continuously, and coverage extends from the earth's surface into lower 
orbit, altitudes. Several studies [Ellis, 1978] have shown that, interfer- 
ometric direction finding applied to two or more GPS satellites can provide 
a very accurate attitude measurement. However, considerable active circuitry 
is required on the passive spacecraft to enable relay of the GPS signals to 
the active spacecraft for processing and attitude determination. While the 
NAVSTAR/GPS should be a useful attitude reference for large, active space- 
craft. or stations, it does not appear to be an appropriate sensor for rendez- 
vous and docking with a passive spacecraft. 
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1.4 OBJECTIVES OF STUDY 


The polarized interferometer is not the only system capable of measuring 
both relative position and relative attitude. However, it has several poten- 
tial advantages, including: 

• Real-time operation, 

• Accurate tracking at all ranges, and 

• Operation unaffected by direct sunlight. 

While the polarized interferometer has considerable potential, it is 
(to date) an untested concept. This report presents the results of a prelim- 
inary evaluation of the feasibility of the pol ari zed-i nterferometer concept. 
The feasibility study comprises three principal areas of investigation: 

• Development of position-and-attit.ude tracking filters and the deter- 
mination of sensitivity parameters, 

• Evaluation of various types of transponders suitable for the passive 
spacecraft, and 

• Preliminary system design. 


1.5 ORGANIZATION OF REPORT 


This report, is divided into 0 chapters. 

Chapter 2 defines one-way and two-way coordinate frames, and the posi- 
tion and attitude variables that are used in the analyses in subsequent chap- 
ters. The locations of individual antenna elements on the host spacecraft, 
are also specified. 

An i ni t i a 1 i zat i on algorithm for the polarized i nterferometer is pre- 
sented in Chapter 3. This algorithm uses nonlinear estimators to determine 
unambiguous position and attitude estimates without the benefit of any ,r 
information. 

Chapter 4 presents a minimum-variance linear tracking algorithm. This 
algorithm is segmented into individual minimum-variance linear estimators for 
range, forward direction, reverse direction, and relative rol 1 . The sensi- 
tivities of the estimates to measurement errors are determined and plotted. 

Minimization of the complexity and power consumption of the passive- 
spacecraft transponder is essential. Chapter 5 examines the feasibility of 
simple-repeater and nonlinear reflector concepts that make the transponder 
nearly passive. However, such techniques are shown to be suitable only for 
short-range operation. 

Chapter 6 reviews frequency assignments, modulation techniques, and 
antenna elements for the passive-spacecraft transponder. Multiple-carrier 
CW transmissions from crossed-slot. or crossed-di pol e antennas are shown to 
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be preferable. 

Multiple-carrier CW ranging is analyzed in Chapter 7. The dependence of 
range accuracy and the probability of ambiguity-resolution error upon SNR is 
determined. 

Chapter 8 uses previously derived relationships and algorithms to devel- 
op and to simulate a polarized-interferometer system design. Candidate de- 
signs based upon carrier-frequency and difference-frequency tracking are de- 
veloped. An RF simulation subroutine is developed and combined with the 
tracking algorithms to implement a system simulation. The results of simu- 
lated operation validate the system design and show the feasibility of the 
concept. 

Chapter 9 summarizes the results and presents the conclusions of this 
study. 
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CHAPTER 2 


COORDINATE DEFINITIONS 


This chapter defines the position and attitude coordinate relationships 
used in the analysis of the polarized-interferometer system. Of the numerous 
possible definitions of attitude, the azimuth-elevation-roll convention is 
preferred here because of its direct correspondence to the angles measured 
by interferometric direction finding. However, no single coordinate frame is 
convenient for all aspects of rendezvous and docking, hence coordinate con- 
version is required in any case. 


2.1 COORDINATE FRAMES 


One-Way Coordinates 

Figure 1-1 illustrates the use of standard "one-way" coordinates. Posi- 
tion can be defined in rectangular coordinates by the vector ( x,y t a ) or in 
polar coordinates by the three-tuple (a,0,p); the angles a and B are called 
position azimuth and position elevation. The relationships between the rec- 
tangular and polar coordinates are well known and are therefore not discussed 
here. 


Attitude is specified by a set of three Euler angles in a particular se- 
quence. The sequence shown in Figure 1-1 comprises attitude azimuth ♦ , atti- 
tude elevation ii , and roll ^ . The zero-attitude condition aligns the at- 
y x 3 

titude of the target spacecraft with that of the active spacecraft. Note 
that in the zero-attitude condition, both spacecraft face the same direc- 
tion, rather than each other. 


Two-Way Coordinates 

The two-way coordinate system shown in Figure 1-2 treats both space- 
craft as equals. The position of the target spacecraft with respect to the 
active spacecraft is specified by two angles and range, as in one-way polar 
coordinates. However, the position of the active spacecraft with respect to 
the target spacecraft is similarly specified by range and two angles (a and 

S ) defined relative to the target spacecraft's own coordinate frame. 

2 


Position and attitude comprise six degrees of freedom. The two sets of 
position angles (a , 0 , o^, and 0^) and range p account for five degrees of 

freedom. The relative roll angle between the two coordinate frames in 

Figure 1-2 accounts for the sixth degree of freedom. 
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Rel ationshlp 

Obviously, the one-way and two-way coordinates define the same slx-de- 
grees-of-f reedom situation. The polar-coordinate form of the one-way posi- 
tion is identical to the two-way form of the position of the target space- 
craft with respect to the active spacecraft. It is therefore apparent that 

the three-tuples (ip , ip , ip ) and ( 0 , 0 , ip ) must provide equivalent atti- 
^ y * 2 2 

tude information. Thus the relative roll angle and the angular position of 
the active spacecraft with respect to the passive spacecraft are equivalent 
to specification of the attitude of the passive spacecraft with respect to 
the active spacecraft. 

Two sets of attitude angles are most easily equated or converted through 
formation of a direction-cosine or attitude matrix A. Individual rotations 
are combined by multiplying appropriate three-dimensional rotation matrices 
(Table 2-1) in the proper order [Raab, 1979, 1981; Thelander, 1965]. The 
attitude matrix in one-way coordinates is therefore 


A - T T. r, 

It Ip Ip 
x y 3 


cos ip cosip 
y 3 


cosip si nip 

u " 


- sinty 


y 


- cosip,, simp, 

X 3 


C0SP x cos<P 2 


+ simp^ sinip^ cosip^ + sirnp^. simp^ simp a 


si nip cos ip 
x y 


siny„ s i nip 

X 3 


- simp cosip 

X 3 


+ cosip sinip cosip + cosip simp simp 


y 


y 


cosip,, cosip 

x y 


(2-1) 


Note that the columns of A are the direction-cosine vectors corresponding to 
the axes of the target spacecraft coordinate frame. 

Determining the form of the attitude matrix in two-way coordinates is 
somewhat more complicated. It is instructive to begin by setting the passive 
spacecraft at zero attitude (Figure 2-1) and noting the relationships among 
a , a , 0 , and 0 , When the attitudes of both spacecraft are the same, 0 
121 2 2 

= -0 and a = n + a . By starting with a and working through the sequence 
121 1 

of five rotations. 


A 


it-c*2 





T 

ai 


( 2 - 2 ) 


This expression can be expanded to obtain trigonometric expressions for the 
elements of A; however, the results are too complicated to be of much use. 


Conversion of two-way coordinates to one-way coordinates is achieved by 
calculating A from (2-2) and equating the result to (2-1). The one-way attitude 
angles are then obtained from 
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y 
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sin 
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cos 
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♦ 

y 

0 

cos 

y 


— 




_ 
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Roll 

rotates 

Y into -Z 



l 

0 

n 


1 

0 


0 


ii 

0 

COS Y 

sin y 

II 

0 

cos 

*x 

sin 

*x 


0 

-sin Y 

COS Y 


0 

-sin 

*x 

cos 

*x 










— , 


Notes: (1) J 1 " 1 = T 


= T , T T a * T a T , 
-a* a 0 0 a' 


T T 

0 ' 3 " 


= T, 


3' + 6" » 


etc. 


(2) Position roll Y is used only as a dummy variable and does not 
define position or attitude. 

(3) The matrices shown here rotate coordinate frames , not vectors. 
To rotate vectors, reverse the signs of the angles and the 
sequence of the rotations. 


Table 2-1. Orthogonal rotation matrices. 
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Figure 2-1. Zero attitude 


(2-3) 

(2-4) 


<1* * arctan {a /A ) , 

3 12 11 

= arctan {A /A ) , 

x 23 33 

and 

* = arctan [(>4 cos * )/A ] . (2-5) 

& 13 * 1 1 

Using the ratio in (2-5) rather than arccos eliminates common gain errors. 

y 

2.2 ANTENNA LOCATIONS 


Antenna arrays are located in the Y-Z planes of the appropriate space- 
craft, as shown in Figure 2-2. This geometry is consistant with the defini- 
tion of zero attitude given in the previous section. Specific antenna-ele- 
ment locations and ranges are defined here for future reference. 


Ranges 

Each antenna array has four distinct elements; elements In the array on 
the active spacecraft are a , a , a , and a , while the elements in the array 

0 12 3 

on the passive spacecraft are designated p^, p^, p^, and p^. A total of 16 

different ranges are defined by the two sets of four elements. A particular 
range is designated p m , where m is the element of the active array and n is 

the element of the passive array. 

The principal spacecraft-to-spacecraft or array-to-array range measure- 
ment is p , which is the distance between the two common antenna elements. 

o »o 

When p is used without subscripts or the term "range" is used without further 
qualification, it refers to p 

o»o 


Coordinates of Antenna Elements 

For present purposes, the three receiving elements of the active array 
are assumed to be spaced evenly In a circle of radius R a . The common (trans- 
mitting) element is located at the center of the coordinate system, thus 

« Q ( 1) - [0. 0, Of . (2-6) 

The polarization-sensing element is arbitrarily positioned on the neg- 
ative z axis, thus its position vector in active-spacecraft coordinates is 
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Figure 2-2. Antenna arrays 



(2-7) 


«,(i) ■ [0, 0, -if n a . 

The positions of circularly polarized elements A2 and A3 are then 
a (1) - [0, - sin 120°, - cos 120°] r R 
- [0, -3 l/2 /2, ♦ l/2f R a 
2 [0, - 0.866, + 0.5] r R a (2-8) 

and 

« 3 (1) “ [0, + 3 l/2 /2, + 1/2? R a . (2-9) 


The locations of the elements of the passive array are similarly de- 
fined. If R represents the radius of the passive array, then the locations 

of its elements in passive-spacecraft coordinates are 


and 


P 0 (2) » [0, 0, Ilf 

(2-10) 

P,(2) * [0, 0, -if (? p 

(2-11) 

pf2) ■ [0. - 3 l/2 /2, l/2f S p 

(2-12) 

P 3 (2) * [0, + 3 l/2 /2, l/2f S p . 

(2-13) 
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CHAPTER 3 


INITIALIZATION ALGORITHM 


Systems such as the polarized interferometer may be required to acqu’re 
Initial estimates of the target-spacecraft position and attitude with little 
or no a priori knowledge about the estimates. In such cases, It Is often 
useful to use two distinct estimators. The first algorithm provides an unam- 
biguous (but not necessarily minimum-variance) Initial estimate. The second 
algorithm then tracks target-spacecraft position and attitude and provides 
minimum-variance estimates. The tracking algorithm Is generally based upon 
Kalman-fi Iter techniques, linearized system equations, and small changes In 
parameters. The Initialization algorithm generally employs nonlinear and/or 
sorting techniques. 

This chapter presents an Initialization algorithm for the polarized in- 
terferometer. This algorithm Is based upon four separate steps, which deter- 
mine (In sequence): 

• Range 'rom round-trip timing, 

• Target position angles by radio interferometry, 

• Two target-attitude angles by reverse Interferometry, and 

• Roll angle from polarization. 

The Initialization algorithm Is formulated under the assumption that the 
spacecraft -to-spacecraft distance is large in comparison to the diameters of 
the antenna arrays. This assumption results 1 r. parallel element-to-element 
paths. Consequently, differences in time of arrival are due to direction of 
arrival alone. This assumption Is reasonable for the initialization algo- 
rithm, as the two spacecraft should be separated by a considerable distance 
when tracking is initiated. 


3.1 RANGE 


The first of the six parameters to be determined is range. In general, 
a measured two-way range has the form 


R » p + p . , + p S 2p + p . . + Ap + Ap 

1,1 0,0 delay 1,1 o,o delay lP 


(3-1) 


where p delay represents the delay introduced by the passive array. There are 
nine such measurements (Figure 2-2). 


The pa*h-length increments due to the directions of arrival at the ac- 
tive and passive arrays are represented by Ap and Ap , respectively. Let 

the direction of the passive array with respect to the active array be repre- 
sented by unit vector » a . The path-length increment at the active array (Fig 

ure 3-1) is obtained by projecting * a onto the antenna-element vector a , 
thus 
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Figure 3-1. Iwo-element interferometer. 
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Figure 3-2. Unit vectors. 
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The sum of the 

C‘a:v* .... Id 

Of POOR QUALITY 
T 

Ap = p -p -as . 

l a 1,0 0,0 l a 

three path-length increments at the active array is 

(3-2) 

Ap 

1<Z 

T T T 

+ Ap + Ap = - a s - a s - a s„ 

2 a 3 a 1 2 3 a 


For the symmetrical 

rp 

- - {a + a + a )~ . 

1 2 3 a 

arrays envisioned for this system. 

(3-3) 

hence 

a - a + a + a = 0 , 

0 12 3 

(3-4) 


Ap + Ap + Ap = 0 . 

2 a 3 a 

(3-5) 


Since the arrangement of the elements in the passive array is also symmetri- 
cal, a corresponding relationship holds for the path-length increments at the 
passive array. 


The sum of the three distances measured from the same element of the 
passive array is therefore 

R + R + R 2 6p + 3 Pj i _ . 

1,1 2,1 3,1 0,0 delay 

Rearrangement of (3-6) therefore yields the desired A0-P0 distance 


p = p = [R + R + R 

0,0 1,1 2,1 3,1 


3p, 


,)/« 


delay' 

Analogously, all nine range measurements should be averaged to provide 
greater accuracy. 


(3-6) 

(3-7) 


3.2 DIRECTION FINDING 


Interferometric direction finding is based upon the relationship between 
the path-length increment and the direction of arrival. Most modern radio 
interferometers do not actually add the signals from the various elements to 
produce an interference pattern. Instead, the phases of each output are 
measured and processed digitally to determine the angle(s) of arrival. 


Two -Element Interferometer 

It is instructive to begin by analyzing the two-element interferometer 
shown in Figure 3-1. From (3-2), the path-length increment between elements A1 
and A2 is 

ip = Ap ia - Ap^ - ( 0i - a z ) T . (3-8) 

It is convenient to define the baseline vector as 
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b = a - a 

1 2 


(3-9) 


which simplifies (3-8) to 

Ap = b T e = |b| sin a . (3-10) 

The difference between the phases of the outputs from elements A1 and 
A2 is therefore 


A$ = 2n Ap/X + 2itfc 


(3-11) 


where 

X is the wavelength of the signal and k is an "ambiguity constant" that maps 
$ into the range 0 < <j> < 2*. If the phase ambiguity is properly resolved, 
the angle of arrival a is obtained from 

a = arcsin(Ap/|b| ) = arcsin(X A<j>/2*|b|) . (3-12) 


Three-Element Interferometer 

Determination of both the azimuth and elevation angles of arrival re- 
quires a minimum of three interferometer antenna elements. Consider first 
the direction of arrival at the active array. The applicable information 
is the set of three ranges from the receiving elements of the active array 
to the common element of the passive array. For example. 


where 


p = (p 

1,0 1,1 


+ p 

1,2 


+ P 

1,3 


)/3 


(3-13) 


p = <{> X /2n 

1,1 1,1 l 


(3-14) 


The equations developed in the previous subsection can be used directly 
to determine the angles of arrival with respect to the three baselines of the 
arrays (Figure 2-2). However, since the baselines are not necessarily align- 
ed with the coordinate axes, the baseline angles are neither readily used nor 
readily manipulated. 


Equations (3-8) - (3-10) suggest that the path-length increment for a 
desired baseline (e.g., one aligned with the coordinate axes) can be synthe- 
sized from the path-length increments for the real baselines. Figure 3-2 de 

fines the unit vectors aligned with the Y and Z axes as 

l l 


« = [0, 1, 0/ 


and 

= [0, 0, if 


(3-15) 

(3-16) 


From the array -geometry definitions given by (2-7), (2-8), and (2-9), 
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(3-17) 


and 


» ■ («, * « 3 - 2 0^/(3 K a ) . 


(3-18) 


The y and s components of unit vector a are its projections onto the 
y and Z axes. From (3-17), 


% m * ’a = K 8 a - a l R a) 

(3-19) 

- [- + AP 2<i ]/(3‘' 2 R a ) 

(3-20) 

= C(p - p ) - (p - p )]/(3 1/2 R ) 

1,0 3 , C 1,0 2,0 a 

(3-21) 

= [p - p ]/(3 1/2 R) . 

2,0 3,0 a 

(3-22) 

use of (3-18) yields 


s =y i a = (a + a - 2a) 1 a/ (3/?) 
az a 2 3 1 a 

(3-23) 

» (2p - p - p )/(3 R) . 

1,0 2,0 3,0 a 

(3-24) 


Since is a unit vector, the magnitude of its x component is obtained 


from 


- 1 - 


- s 


2 


ax ay as 

Proper orientation of (Figure 3-2) requires that < 0. 
or by analogy to the top row of the A matrix (2-1), 


(3-25) 

Fr m intuition 


a 

a 


COS 0 COS a 
1 1 

COS 0 sin a 
1 l 

- sin 0 

l 


(3-26) 


The azimuth and elevation angles of arrival are now obtained by equating (3-?6) 
to the components given by (3-22), (3-24), and/or (3-25). 


Direction Finding at Passi ve Array 

Techniques analogous to those developed above are used to determine the 

direction-of-arrival angles a and 0 at the passive array. Under the as- 

> ? 
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sumption of a large array-to-array distance, the distances from the transmit- 
ting element AO to the three elements of the passive array have forms such 
as 


p = (p + p + p )/3 , 

0,1 1,1 2,1 3,l' 


(3-27) 


which is analogous to (3-13). 


A unit vector that points from the passive array to the active array 

is defined by analogy to « a . The projections of onto the passive-array 

Y and Z axes are [by analogy to (3-22), (3-24), and (3-25)] 

2 2 


and 


a ■ (p - p )/(3 1/2 R) , 
py y o,2 0,3' v p' 


S = (2p - p - p )/(3 R ) , 

P z 0,1 0,2 0 , 3 ' P' 


(3-28) 

(3-29) 


e 2 = 1 - e 2 - e 2 
px py pz 


(3-30) 


In this case, s <0 causes a„ to point toward the active array under condi- 
px P 

tions that allow signal reception. Angles 0 ^ and are found by analogy to 
(3-26). 


3.3 ROLL 


The remaining unknown, relative roll v|< , is determined from signal 

polarization. Relevant information is imbedded in the four amplitude 
measurements corresponding to the two linearly polarized transmitting ele- 
ments in the passive array and the two linearly polarized receiving elements 
in the active array. It is necessary to determine the direction of arrival 
angles c^, 0^ , 0 ^, and 6^ prior to determining the roll angle. 

The far-field coupling between two electrically short dipoles is deter- 
mined entirely by their relative orientation and the distance separating 
them. Consequently, it is convenient to formulate the coupling relationships 
in terms of rotations by the position and attitude angles. Modified forms of 
these relationships can be used with longer antennas, provided their patterns 
are known. 

Let the moment of a particular dipole in element PI of the passive array 
be represented by vector tf(2), which is defined in passive-array coordinates. 
The field vector observed at the active array is then the same vector v(l) 
converted into active-array coordinates. The relationship between t>(l) and 
v{2) is obtained by applying the same rotation matrices used in (1-1) to de- 
fine attitude matrix A , thus 
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(3-31) 


v(l) « G T T a F T t T . T v(Z) . 

1 ' -<*1 - 0 i -02 - oi 2 v 

Above, the absence of a radial far-field component is accounted for by the 
matrix 


F = 



0 

1 

0 


0 “ 

0 

1 


(3-32) 


and G represents the combined effect of receiver gain, antenna pattern, and 
path loss. In terms of one-way position and attitude parameters, the cou- 
pling relationship is given [Raab, 1979, 1981] by 


v(l) = T T a FT T T T . T v(Z) 

-<n -0i ei oi -♦ -^ x v ' 

= T T FT, T A T V(Z) . (3-33) 

-ai -01 01 ai ' 

Element AI of the active array includes two orthogonal, linearly polar- 
ized elements, and can therefore sense only the and components of the 

incident signal. Element PI of the passive array includes two orthogonal 
linearly polarized elements that may be represented by 

«(2) ■ [0, e u , 0/ (3-34) 


and 


v(Z) = [ 0 , 0 , G v f 


(3-35) 


where G and g v represent the processing gains of the two channels in the 
passive array. 


The four available measurements are more than sufficient to determine 
the single unknown parameter >P r . However, the presence of matrix F in (3-31) 

results in a degenerate set of three-dimensional equations and precludes 
solution by matrix inversion. 

Formulation of the coupling relationships in the tracking coordinate 
frame (Figure 3-3) leads to a soluble two-dimensional set of equations. 

First, assemble the two passive-array excitation vectors into the 3 * 2 ma- 
tri x 


v( 2) - [«(2):»(2)] . (3-36) 


The equivalent in tracking-frame coordinates is given by 

fcT(O) =[u(0)!i>(0)] = F T ^ r o2 W(Z) = <3 *T(2) . (3-37) 

This pair of vectors can then be converted further into active-array coordi- 
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Figure 3-3. Tracking coordinate frame. 


nates, thus 

*r(i) « [M(1) |v(i)] = a r_ ai f(o) = a p v(o) . (3-38) 

Equations (3-3G) and (3-37) form the basis of the solution. The next step 
is to synthesize tracking-frame measurements from active-array measurements. 
This is not a simple coordinate conversion problem, since the x coordinates 
are either unobservable or identically zero. From Table 2-1, 


■«1 “Si 
COS 0 COS a 

- sin a 

sin 

0 

COS a 

1 

i 

l 


l 

1 

COS 0 

sin a 

COS a 

sin 

0 

sin a 

1 

1 

1 


l 

l 


- sin 3 0 cos 6 


(3-39) 


— l l — 

The effects of the first row are unobservable, and the first column has no 
effect since it always acts upon the radial component of the signal, which 
is zero. 


The lower, right four elements relate the measurements to the tracking- 
frame vectors. For example, 

u (1) = (cos a ) U (0) + (sin 6 sin a ) u z ( 0) (3-40) 

*j 1 11 

and 


u x (l) = (cos 0) « a (0) . 


(3-41) 


The y and z components of tracking-frame vector u{ 0) are therefore obtained 
from the measured components of u(l) by 


VO) = u g (l)/cos 


and 


u ( 0 ) = 


« M (1) - (sin 0 1 sir to) « s (0) 


JL 
cos a 


(3-42) 

(3-43) 


l 


Analogous relationships apply to v. 


The relationship between the tracking-frame vectors and the passive- 
array excitation vectors is imbedded in the Q matrix, defined in (3-36). By 
multiplication or by inspection of (2-1), 


¥ T 


-I* -32 


r 

-Q2 
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cos cos a 
r 2 

- sin Y sin 0 sin a 
r 2 2 


sin 4i cos a 
r 2 

+ cos il> sin 6 sin a 
r 2 2 


- sin ill,, cc’ 0 
r 2 


cos 'll cos 0 
r 2 


(3-44) 


where the asterisks represent unneeded elements. Premultiplying W(2) by Q 
yields relationships among the four scalar variables: 


and 


y°> * 

(cos 'li r 

cos a - 
2 

sin 


sin 0 

2 

sin « z ) G u , 

(3-45) 

y°> ■ 

(sin P v 

COS <3 + 

2 

cos 

K 

sin 0 

2 

sin a 2 ) G u , 

(3-46) 


v (0) 
IT ' 

= (- sin 

p 

V 

COS 

V 

> 

(3-47) 


v z (0) = (cos 

K cos 


A 

(3-48) 

; evident 

that the roll angle 

is 

now given by 




arctan[- 

^(0)/ 

£ 

O 

l—l 

• 

(3-49) 


This is an especially desirable relationship, since it requires knowledge of 

neither 0 nor G ,, and should therefore not be affected by errors in those 
2 v 

variables. Note that the signals corresponding to vector u{2) in the passive 
array are not necessary. However, they may prove useful in reducing the sen- 
sitivity of the tracking filter at certain attitudes. 

It is interesting to note that if C y is known, 0^ can be determined 

from the polarization measurements alone; i.e., 


0 = 
2 


arccos[- v y {0 )/G y sin <1^] 
arccos[v 3 (0)/G y cos 1^] 


Given 4» r and 0 , (3-44) and (3-45) can be solved for o^. 


(3-50) 

This suggests that a 


single linearly polarized element can suffice as the passive array. However, 
it is doubtfully desirable to eliminate the other elements of the passive ar- 
ray, since G y may turn out to be somewhat variable, and errors in 6 y lead 


28 


directly to errors In e , hence also a 
3 2 2 


3.4 SIMULATION ANO RESULTS 


The validity of the algorithms developed above Is verified by the simu- 
lation program listed in the Appendix. The algorithms were tested at an as- 
sortment of positions and attitudes. Proper operation was observed in all 
cases. Numerical errors are generally no larger than the fifth significant 
digit. 

These tests verify the validity of the initialization algorithm. In 
addition, they verify the validity of the formulations used to develop the 
algorithm. 

The initialization algorithm uses only signals from the Z-orlented 
linearly polarized element of the passive array. It therefore appears possi- 
ble to simplify the passive array by eliminating one of the two proposed 
linearly polarized elements. However, sensitivity analysis (Chapter 4) shows 
that use of both elements is desirable. 
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CHAPTER 4 


MINIMUM-VARIANCE TRACKING ALGORITHM 


An algorithm for making initial estimates of target-spacecraft position 
and azimuth Is described in Chapter 3. That algorithm uses nonlinear func- 
tions to produce unambiguous estimates, and requires no a priori Information 
on the target-spacecraft parameters. 

However, nonlinear estimators do not ensure optimum blending of all 
available Information, and may even accentuate noise under certain condi- 
tions. Consider, for example, 

y = (2 + e ) 1/2 » (4-1) 

and suppose e s 0.01. If z * 1, Ay * 0.005. However, If a « 0, by • 0.1, 
which represents a factor-of-ten amplification of the error. 

In contrast, a minimum-variance linear estimator (MVLE) blends all 
available information into the best possible estimate of the unknown parame- 
ters. For a Gaussian-noise environment, an MVLE is the best of all possible 
estimators (linear and nonlinear) with respect to both minimum-squared-error 
(minimum-variance) and maximum-likelihood criteria [Nahi , 1969; Monzingo, 
1980]. It is therefore desirable to include such an estimator in the track- 
ing algorithm for the polarized interferometer. 

The Kalman filter [Brown, 1983] is a recursive type of MVLE based upon a 
state-space model of system (in this case, spacecraft) dynamics. Kalman fil- 
ters make full use of known interrelationships between position, velocity, 
and acceleration, and are therefore widely used in navigation and tracking 
systems. However, a Kalman filter is effective only when the system model is 
accurate; a Kalman filter with an inaccurate system model may produce poorer 
estimates than a simple MVLE that has no provision at all for dynamics. In 
general, Kalman filters are used to estimate parameters such as gyro drift 
(that have stable statistics), rather than position and velocity (whose sta- 
tistics may vary at the whim of a pilot). 

The polarized interferometer may be used with a number of different 
chase and target spacecraft. Neither the spacecraft, their dynamics, nor 
their guidance/control algorithms had been specified at the time of this 
study. It is therefore preferable to implement an MVLE algorithm that esti- 
mates position and attitude only. At some later date, a Kalman filter can be 
developed to process the MVLE output to extract position, velocity, attitude, 
and attitude rate. 


4.1 MVLE THEORY 


The theory behind minimum-variance linear estimators can be found in a 
number of texts [Nahi, 1969; Monzingo, 1980; Brown, 1983], For a Gaussian- 
noise environment, the form of the MVLE can be derived either by minimizing 
the squared estimation error or by maximizing the log-likelihood function. 
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For estimation cf a scalar from several uncorrelated measurements, the MVLE 
simply amounts to an Inverse-variance weighting of the measurements. 

The polarl zed-interferometer system measures a set of ranges and field 
amplitudes that are related to target-spacecraft position and attitude 
through a system of nonlinear equations. The use of an MVLE In a nonlinear 
system requires linearization of the system equations In the vicinity of the 
estimate. The nonlinear posltlon-and-attltude estimator (Chapter 3) provides 
Initial estimates suitable for this purpose. 

The MVLE for a linearized system deals with small changes In the 
measurements and small changes In the estimates. The general form of the 
MVLE for a linearized system Is 

x{k) * x(k - 1) + Ax , (4-2) 

where x(fc) Is the vector of estimates at sample k. The estimated change In 
the estimate vector from one sample to the next Is 

Ax * B by , (4-3) 

where B Is the blending matrix and 

a vW - y(k - 1) (4-4) 

is the sample-to-sample change in the measurements vector y(k). 


The blending matrix is obtained from the product of three matrices: 



B * B <? L' 1 . 

(4-5) 

Above, 

the error-covariance matrix B is given by 



B « {<? L~ l G)' 1 , 

(4-6) 

where 

L * E[n n ? ] 

(4-7) 


is the covariance of additive measurement noise n and 


G 


3y /3x 

1 l 

/ax 

2 1 


3 y /3x 
1 2 

3 y /3x 
2 2 


* y M^ X N 


(4-8) 


contains the set of gradients of the measurements with respect to the pa- 
rameters to be estimated at the point of 1 inearlzation. Matrix G is a gener- 
alization of the gradient vector, and M > N. The same estimates can be ob- 
tained by formulating N scalar MVLEs that act upon the same M-element meas- 
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urement vector y. 


4.2 MVLE IMPLEMENTATION 


The parameters to be estimated Include: 

• Three position-coordinate changes, 

• Three attitude Increments, and 

• Two excitation factors. 

The first six parameters represent changes In the desired position and atti- 
tude information. The two excitation factors [A u and A y In (3-34) and (3-35)] 

are not useful per ee* However, they enter into the amplitude-coupling re- 
lations and are unknown, and must therefore be estimated If the roll angle is 
to be estimated accurately. 

A straightforward M brute-force M implementation of the MVLE would follow 
the form given in Section 4.1. The measurement vector y would comprise the 
nine range measurements and four amplitude measurements. The Incremental 
estimate vector Ax would comprise three position increments, three attitude 
increments, and two excitation factors. Position would be tracked as a vec- 
tor, while attitude would be tracked as either a quaternion or a direction- 
cosine (attitude) matrix. The estimated position vector would be updated by 
simple addition, while the attitude matrix or quaternion would be updated by 
suitable multiplications [Parrel, 1976; Tietz, 1982]. The G matrix would be 
determined by numerical calculations, using the previously derived range and 
coupling equations (Chapter 2). 

The brute-force approach is theoretically sound. However, it is subject 
to practical computation problems due to the greatly differing magnitudes of 
the different parameters (position coordinates, attitude angles, and excita- 
tion factors) to be estimated. Furthermore, the radial component of position 
error is very small in comparison to the cross-track component of position 
error. Even if the brute-force approach were implemented with double- or 
quadruple-precision computations, the linearization problem discussed subse- 
quently would prevent it from working properly. 

The solution is to implement separate MVLEs for each group of similar 
quantities; i.e., 

• Range, 

• OF from the active array, 

• DF from the passive array, 

• Roll, and 

• Excitation factors. 

Each individual MVLE is applied in sequence and improves the estimate availa- 
ble to the next individual MVLE, as shown in Figure 4-1. This approach sim- 
plifies the computations somewhat, since smaller matrices must be inverted, 
and offers a limited degree of redundancy. It is interesting to note that a 
similar approach is often taken in integrated navigation filtering when in- 
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Figure 4-1. MVLE tracking filter. 
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puts are obtained from a variety of different sensors, some of which are not 
always available. 

The characteristics of the individual estimators are described below. 
The specific implementations of the estimators can be found in the Appendix. 


Range Estimator 

The range MVLE estimates the scalar Ap from the set of nine changes In 
the nine element-to-element range measurements. Its form follows Section 4.1 
exactly, except that some parameters (e.g., covariance) are scalars. 

For ranges of 10 km or more, this estimator can be implemented as a 
fixed linear average of all nine range measurements, as in the initialization 
algorithm (Chapter 3). However, at shorter distances, the small errors in- 
troduced by this approximation degrade OF accuracy. At very short distances 
(e.g., < 10 m), the use of true gradients improves the accuracy of the range 
estimate considerably. 


Direction-of-Arri val Estimator 


The direction of the passive array with respect to the active array is 
represented and tracked as the unit vector £. Tracking the direction angles 

a and e themselves is difficult and undesirable because of singularities 
l l 

in the coordinate-frame conversions [Raab, 1979]. 

It is desirable to estimate the components of position error that are 
orthogonal to the direction vector t, since range error has previously been 
estimated (and now is presumably very small). This is accomplished by esti- 
mating local changes Aa and Ag in the direction of arrival. The MVLE output 
vector therefore has the form 

A* = [Aa, Ag] r . (4-9) 

Updating of the direction vector is then accomplished by incremental rota- 
tion: 


* r .4« r _ la e< k - 1) • 


(4-10) 


Incremental rotation matrices can be obtained by applying small -angle 
assumptions to the matrices of Table 2-1, thus 


T T 

-A0 -Aa 


0 -Aa 
A a 0 
-A0 0 


A0 

0 

0 


(4-11) 


After using a rotation based upon the small-angle assumption, it is essential 
to normalize 5 to unit lpngth. In general, use of the small-angle assumption 
followed Dy normalization requires less computation time than does a large- 
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angle rotation 


The gradient matrix is computed by dithering Z and differencing the pre- 
dicted measurements with those of the undithered Z, Dithering of Z is accom- 
plished by incrementally azimuth or elevation rotations. For example, a 
positive incremental local -azimuth rotation is accomplished by 


The elements of G are then determined from 

_ y^V) - y t { oZ) 

3a pAa 

or an analogous form for Afl. 

The direction-finding MVLE was first implemented using a y vector com- 
prised of all nine individual range measurements. Its performance was satis- 
factory if there was no error in the initial estimate of attitude. However, 
given such errors, convergence was slow, and in many cases, the combined al- 
gorithm (Figure 4-1) settled on erroneous values of direction and attitude 
(e.g. , a = 5° and ^ = 5° instead of = 10° and = 0°). This problem 

was found to be inherent in the linearization process and therefore unavoid- 
able. 


(4-12) 

(4-13) 


Obviously, it is possible to estimate both position and attitude cor- 
rectly, since the initialization algorithm does so. The solution for the 
MVLE algorithm is to form three linear sums of the nine measurements, as 
is done for the initialization algorithm [e.g., (3-13)]. These sums greatly 
suppress the effects of attitude, thereby decoupling attitude and position 
effects and allowing the MVLE to operate properly. Since the estimates of 
angular error are based upon gradients, allowance is automatically made for 
operation at short ranges (in contrast to the initialization algorithm). 


Reverse Pi rection-of-Arri val Estimator 

Tracking of the direction (a^, $^) of the active array with respect to 

the passive array is completely analogous to tracking of the passive array 
with respect to the active array. In fact, the sane software subroutine is 
used. 


The direction of the active array with respect to the passive array is 
represented by unit vector n, which is analogous to Z. Through simple geo- 
metric analogies, it can be shown that 

n = - A' Z , (4-14) 


where 


35 


(4-15) 


A ' 



is the attitude of the active array with respect to the passive array. The 
computation in (4-15) can be avoided by applying selective sign reversal to the 
elements of A. 


The only required modification to the MVLE algorithm is a reordering of 
the nine range measurements prior to condensation into three pseudo-measure- 
ments. The reordering is accomplished by treating them as a 3 * 3 matrix and 
taking their transpose. 


Roil Estimator 


The roll MVLE estimates scalar from the set of changes in the four 

amplitude measurements. The angle is tracked directly, and provision is made 
for mapping the updated estimate back into the range -it < < +w. Since 

only one angle is tracked in this algorithm, there are no singularities due 
to coordinate-frame conversion. 

The roll MVLE is similar to that of Section 4.1 and the previous MVLEs 
in most respects. To avoid cross-coupling of roll and direction effects, 
roll increments must be introduced in the proper sequence when predicting 
coupling. Thus by analogy to (3-31), 

*(i) = c 9{z) - a r Si r 4i r + ^ t h «r(z> . («-i6 


Excitation Constants 

The excitation constants and A^ are related to the total power re- 

radiated by the two linearly polarized elements of the passive array. Since 
these parameters are unknown and vary as the position and attitude change, 
they must be tracked along with position and attitude. 


The MVLE for the excitation constants has the form described in Section 
4.1. In contrast to the previous estimators, the gradient matrix for this 
estimator is easily computed analytically. Let the excitation in (4-16) be 


W(2) 



(4-17) 


The derivatives of the amplitude measurements (i.e., the amplitude gradients) 
with respect to A y and A y are then simply 
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(4-18) 


(4-19) 


Convergence 

In all cases, satisfactory convergence is obtained when the angular 
error does not exceed 45°. Usually, no more than 2 iterations are required 
to reduce the error to the level of round-off errors. In many cases, the 
algorithm converges (with a few more iterations) when the error is as large 
as 80°. The MVLE for range converges in spite of factor-of-ten errors in the 
range estimate. 


Implementation 

FORTRAN subroutines for the MVLE tracking algorithm are listed in the 
Appendix as part of the simulation program. An estimator for the excitation 
factors is not implemented as it is of little use at this stage of develop- 
ment. However, such an estimator will be required in any operational system. 

mplementation of a MVLE tracking algorithm for the polarized interfer- 
ometer is indeed a difficult problem. Operation at ranges up to 100 km ne- 
cessitates the use of double-precision arithmetic in all range-related compu- 
tations, since centimeter errors in range difference can produce significant 
DF errors. In addition, the use of true gradients is necessary for operation 
at short ranges where the antenna-to-antenna paths become nonparallel. 

Nonetheless, considerable simplification of the algorithm for an opera- 
tional implementation should be possible. Direction angles can be derived 
from range difference rather than range; doing so should eliminate the re- 
quirement for many of the double-precision computations. In the present im- 
plementation, all gradients are computed numerically, and are recomputed 
every time they are needed. Considerable time savings (perhaps half) can be 
achieved by eliminating redundant calculations of the same gradient. Fur- 
thermore, it may be possible to derive analytic forms for the gradients that 
are computationally advantageous to numerical techniques. 

A crude estimate of velocity can be obtained by differencing adjacent 


37 


position vectors. Similarly, a crude estimate of attitude rates can be 
obtained by multiplying the current attitude matrix by the transpose (in- 
verse) of the previous attitude matrix and extracting incremental attitude 
angles from the results. Given information about spacecraft dynamics, a Kal- 
man filter can be implemented to smooth the successive velocity and attitude- 
rate estimates. 


4.3 SENSITIVITY ANALYSIS 


designing a polari zed-interferometer system requires knowledge of the 
sensitivity of its estimates to measurement noise. The desired sensitivity 
parameters are the estimate variances and covariances. These are convenient- 
ly produced by the MVLE algorithms. 

Two sensitivity-analysis programs were implemented. These programs use 
the set of subroutines listed in the Appendix. The program determines the 
sensitivity parameters as functions of a roll angle $ and an off-boresight 
angle 6, as shown in Figure 4-2. The results show that the roll angle <*> 
does not significantly affect the sensitivity parameters. 

The range variance is independent of direction and roll, and virtually 
independent of range. The variance of the range error is therefore 

V = Var[p] = of/36 2 0.278 of , (4-20) 

1 y y 

where of is the variance of an individual range measurement. The factor 36 

is due to averaging nine measurements that vary twice as fast as the parame- 
ter being estimated. 


The total variance V of the direction-finding error is three times the 

2 

trace of the covariance matrix H for that estimator. A plot of V as a func 

2 

tion of the off-boresight angle is shown in Figure 4-3. This curve fits the 
relationship 


V 2 0.4448 of/ cos 2 6 , (4-21) 

which is the same as that for a two-element interferometer. 

The OF variance is given in squared radians. For an array diameter of 

1 m and p > 10 m, V is nearly independent of distance and the attitude of 
z 

the other array. The same relationship applies to both passive and active 
.. arrays if the baseline lengths are the same. 

The roll -angle sensitivity V relates the amplitude-measurement error 

4 

variance to the roll-angle error variance. It is based upon a normalized 
maximum amplitude measurement of unity and can therefore easily be used to 
determine the required SNR. The variation of '/ with a is shown in Figure 
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Boresight definition. 




4-4 for several values of a . The value of V remains below 2.0 as long as 

jne or the other off-boresight angle is 45° or less. As both cff-bnresi ght 
angles aoproach 90°, the two arrays face away from each other and the error 
sensitivity becomes Infinite. 

Given a good signal -to-noise ratio, relative roll can be determined from 
only two amplitude measurements, corresponding to the signal from only one 
of the elements of the passive array. However, if one element of the passive 
array were eliminated, situations could arise in which both of the remaining 
amplitude measurements have a poor SNR. Therefore both linearly polarized 
elements should be retained. 
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Figure 4-4. Roll sensitivity. 
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CHAPTER 5 


TRANSPONDER CONCEPTS 


The active spacecraft is powered and is assumed to be capable of sup- 
porting a relatively complex electronic system if necessary. However, the 
passive spacecraft may be unpowered and may offer little or no support for 
on-board electronic systems. The failure of systems on board the passive 
spacecraft may, in fact, be the reason for the rendezvous. Minimization of 
the complexity and power requirements of the passive-spacecraft transponder 
is therefore essential. 


5.1 APPROACHES 


A variety of conventional receiver and transmitter circuits can, of 
course, be used in the passive-spacecraft transponder. The objective of this 
chapter is to evaluate the possibility of implementing a passive or almost- 
passive transponder for the passive spacecraft. Two candidate approaches 
are: 


• Simple repeater 

• Nonlinear reflector. 

The simple repeater (Figure 5-1) consists of a local oscillator, mixer, 
and suitable bandpass filters ar its input and output. The filters must be 
wide enough to allow for anticipated Doppler shifts. Obviously, some power 
is required for the oscillator. Numerous options are possible, including 
adding gain at the input and/or output. Multiplexing of signals from the 
four antenna elemsnts is accomplished by using similar circuits to drive 
all antennas simultaneously but on different frequencies. 

The nonlinear reflector (Figure 5-2) employs bandpass filters and a non- 
linear device such as a diode or FET; power may or may not be necessary. 

When signals are received from the active spacecraft on frequencies corre- 
sponding to the input filters, the nonlinear device generates and reradiates 
a signal on the difference frequency corresponding to the output filter. 
Multiplexing * : s accomplished by employing four such systems with different 
Input-frequency pairs; the active-spacecraft transponder can thus select re- 
radiation from a particular antenna element by transmitting on a particular 
pair of frequencies. 

Pseudonoise modulation may be impressed on the signals to facilitate 
ranying and separation of the returned signal from interference. If both 
signals transmitted to a nonlinear reflector are biphase modulated with the 
same PN code, the returned signal is an unmodulated carrier. If the signals 
from the active-spacecraft transponder are modulated with different codes of 
the same length, the returned signal is itself modulated with a unique PN 
code. The product code [Gold, 1967] modulating the return signal has a low 
cross correlation product with either of the codes on the two forward signals 
and thereby facilitates reception in the presence of IMD products from the 
active-spacecraft transponder transmitter. 
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Figure 5-1. Simple repeater. 



Figure 5-2. Nonlinear reflector. 
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5.2 MIXER CONSIDERATIONS 


Both the simple-repeater and nonlinear-reflector approach mix two sig- 
nals to produce a third signal that Is returned to the active spacecraft. 

This section therefore develops a two-signal model for mixing noisy, modulat- 
ed signals. This model Is used to derive relationships among Input and out- 
put signal -co-noise ratios (SNRs), and these relationships are then used in 
preliminary link calculations. 

Low-power mixers suitable for use in the passive-spacecraft transponder 
include FETs, diodes, and BJTs. The analysis presented subsequently derives 
the noiseless mixing characteristics of both square-law devices (FETs) and 
exponential -characteristic devices (diodes and BJTs). 


Signal s 

The input signal to the nonlinear device can (in the absence of noise) 
be represented by 


v.(t) - 8 + 8 (t) + a it) , (5-1) 

^ 0 1 2 

where e is a dc bias. The signals from the active-spacecraft transponder 
o 

are 


and 


8 (t) * a m ( t ) cos (co t + d> ) 
l li l l 


(5-2) 


e It) * a m it) cos(u» t + $ ) , (5-3) 

2 2 2 2 2 

where a ^ and a ^ represent signal amplitudes and m^(t) and m^(t) represent 
the biphase PN modulation. 

Range information is imbedded in code timing and the carrier phases 4^ 

and d> . Since biphase modulation is assumed, m = ± 1 and m « ± 1, hence 
2 12 

m 2 * m 2 » 1. 

1 2 


Square-Law Characteristic 

The square-law characteristic of most FETs can be represented by 

°o ' « “I • (5 - 4 > 

Note that bias is included as part of v.. 
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(5-5) 


Insertion of (5-1) and then (5-2) Into (5-4) yields 

u ■ c(e 2 a 2 + e 2 2 a a + 2 a a + 2 a a ) 

° 0 1 2 0 1 0 2 1 2 

■ <?{[a 2 + a 1 J2 + a 2 /2] 

0 1 2 

+ [a^ m^(t) cos(Aut + A$)] 

+ [2 e a m (t) cos (u t + $ ) ♦ 2 a a m (t) cos(u t ♦ 6 )] 

Oil 1 1 0 2 2 2 2 

+ [ a 2 / 2 cos(2 w t + 2 $ ) + a 2 / 2 cos(2 w t + 2 ♦ ) 

1 1 1 2 2 2' 

♦ a a ffi (t) cos { (w +ui)t + (+ + 4> ))]} , (5-6) 

12 3 1 2 1 2 y 7 J ' X ' 

where 


m 

3 


m (t) m (t) 
l 2 


,-7) 


and 

« <$> - ^ . (5-9) 

The four bracketed terms in (5-6) represent dc, the desired difference- 
frequency signal, Input-frequency signals, and double-input-frequency sig- 
nals. These products are similar to those of a true multiplier, and all un- 
wanted products are well removed in frequency from the desired difference- 
frequency product. Because of their "clean" spectral characteristics, 
square-law devices are highly desirable for use as mixers [Krauss, 1980]. 


Exponential Characteristic 

Mixers implemented from diodes and bipolar junction transistors are 
characterized [r'.rauss, 1980; Clarke, 1971] by an exponential relationship be- 
tween their instantaneous input and output signals: 

v 0 55 o exp (<7 v^k T) . (5-10) 

To analyze the use of such devices as mixers, it is convenient to factor 
(5-9) after insertion of (5-1), thus 

v Q * c exp (<7 o Q /k T ) exp (q s^/k T ) exp(g e^/k T) . (5-11) 

Now let 
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(5-12) 


x • q a m ( t)/k T • u m (t) . 

i i 1 11 

The third factor in (5-10) thus becomes [Krauss, 1980; Clarke, 1971] 


exp[x cos (w )]■/(* )+2 Z lAx ) cos(rc w t + n $ ) , (5-13) 

l l l oi n»l 1 1 l 

where 

• n+2fc 


'.w ■ 1 


(5-14) 


Jc0 kl r(n + k + ^ 

is a modified Bessel function of the first kind [Wylie, 1960, p. 418]. 
Since 2k is always even, 


* (0 ). n odd 

). * even 

Combination of (5-14), (5-12), and (5-10) yields 
i> 0 • c exp [<7 r] 


/„(* ) 


(5-15) 


•C-T {y ) + 2m (t) 

o i l 

*[l (y ) + 2m (t) 
o 2 i 


l (y ) cos (u> t + <p ) 

11 l i 

I (y ) cos ( u> t + <p ) 

12 2 2 


+2 I {y ) cos(2w t 
2 1 1 

+ 21 (y ) cos ( 2 uj t 
2 2 2 


+ 2^ ) + . . . ] 

+ 2<p ) + ...]. 

2 

(5-16) 


Examination of (5-15) yields much useful Information about the spectral 
output of an exponential -characteristic mixer: 

• The desired return-signal modulrt^on m^(£) is present only In prod- 
ucts of two odd-order terms. 

• The desired difference frequency is produced only by the product of 
two first-order terms. 

Certain high-order products do produce si gnal s-whose frequencies (e.g., 

<d - mA <d, id - mA ) are near that of the desired return signal. However, 
12 2 

the amplitudes of the signals from the acti ve-spacecraft transponder are rel 
atively small, and small-signal operation of the mixer can be assumed. The 
amplitudes of such spurious mixer products should therefore make them negli- 
gible. 
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5.3 MIXING OF NOISY NARROWBAND SIGNALS 


The spectral products produced by both square-law and exponential -char- 
acteristic mixers have been derived in the previous section. In either case, 
the signal of interest is produced primarily by the term that multiplies the 
two input signals. The portion of the mixing process that is of interest is 
therefore 

V Q (*) = * 2 (t) • (5-17) 

Since the noisy input signals can be characterized as narrowband proces- 
ses, they are represented here by 

o (t) = a m (t) cos (ui t + $ ) + n (t) cos(<d t) + n ( t ) sin(u) t) (5-18) 

li l l i c l l® l 

and 

v (t) = a m ( t ) cos (u t + $ ) + n ( t ) cos(<d t) + n (t) s i n ( co t) , (5-19) 
2 2 2 2 2 2^ 2 2 s 2 


where and a ^ represent signal amplitudes, m^(fc) an( i m ^( t ) represent modu- 
lation, and n , n , n , and n represent narrowband Gaussian noise. To 
1 a l® & 2® 

simplify the analysis, the time dependences and carrier phases are dropped, 
thus the input signals become 


(a m + n ) cos u> t + n sin ui t 
li l^ l l® l 


(5-20) 


and 


v = (a m + n ) cos a > t + n sin w t . (5-21) 

2 2 2 2 ^ 2 2 ® 2 


Since n^(t) and m^(t) represent pseudonoise modulation, their values are 

either +1 or -1, and do not affect signal power. The power in signal #1 is 
therefore 


P = <i 2 /2 


(5-22) 


The in-phase and phase-quadrature noises are statistical ly independent and of 
equal power, hence the noise power accompanying signal #1 is 


= °n /Z + °n /2 = a n 
l'* 1® 1<* 


- cr 


= 


(5-23) 


i i f ' l® r' i® i 

The resultant signal -to-noise ratio (SNR) for signal #1 is therefore 
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(5-24) 


(? = <tJ/(2 o* ) . 

1 

By analogy, the SNR for signal #2 is 

R = a 2 /(2 o 2 ) . (5-25) 

2 2 ” 


Mixer Products 

Substitution of (5-20) and (5-21) into (5-17) produces the mixer prod- 
ucts 

v = [a m + n )(g m + ) cos u> t cos w t 

Oil l c 2 2 2 ° 1 2 

+ (a m + n ) n cos w t sin ui t 

\ 1 l c 2 8 1 2 

+ n (a m + n ) sin w fc cos w t 

l e 2 2 2 ° 1 2 

+ n n sin w t sin w t . (5-26) 

i e 2 6 l 2 

Multiplication of the trigonometric functions produces 

v = — (a a m m + a n m + a n „ m + n„n,+n /% n) cos Awt 
031212 2 l c 2 1 2 C 1 i c 2 C l e 2« 

+ i(-a m + a m n < . + rt„«„)sin Awt 

2 1 1 2 e l c 2 s 2 2 l e I s 2 C 

+ h.f. terms, (5-27) 

where Au> = u» - u> . For notational simplicity, the individual terms are 
1 2 

denoted as nine quantities according to 

v = — (g + g + <7 + g + g ) cos Au it + — (g + g + g + g) sin Amt 

0 2 1 2 3 4 5 2 6 7 8 9 

+ h.f. terms. (5-28) 

Output Signal -to-Noi se Ratio 

The q ^ term in (5-28) represents the desired output signal, and its 
power is 
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P_ = P. 


1 2 2-1 

= — cr a* = — 


P_ P. 


® ‘<7 q i 2 o’ 8 8 

0 i 8 1 4 2 i 2 


The power in each of the four signal * noise terms in (5-28) is 
P_ = P_ = - a 2 o£ = - P„ P„ 
and 


L ' 7 


8 8 2 \ 4 


8 n 
2 1 


P n = P„ = - a 1 o 2 = - P fl P n 

(7 (7 a ] i fi ^ 

*3 6 8 1 2 4 1 2 


1 


(5-29) 


(5-30) 


(5-31) 


Similarly, the power in each of the four noise * noise terms in (5-28) is 

(5-32) 


p = p =p = p = -L a 2 o 2 - — P P 
<7 <7 <7 <7 o n n „ r n 

\ ^5 6 7 2 i 2 2 i 2 


Since both the signal * noise terms and noise * noise terms represent noise 
corrupting the output signal, the total noise output power is 


p = A p p + A p p + 2 p p_ 

* , e n . s n n n 

0 4 i 2 4 2 l 12 

The output SNR is given by the ratio of (5-29) and (5-33), thus 

2 P„ P a 
8 8 

R = 1 1 


(5-33) 


0 P P + P P +2 P P 
8 n 8 n n n 

12 2 1 12 


(5-34) 


2 R R 

= 1 — 4— . (5-35) 

P + R + 2 
1 2 

If the two input SNRs are the same, P = P , and 

1 2 

P 2 

P = ! (5-36) 

0 P + 1 
l 


This relationship between input and output SNR is graphed in Figure 5-3. 

For both high and low input SNRs, (5-36) reduces to simple asymptotic 
relationships: 


P 

o 


P , P » 1 
l l 

P 2 , P « 1 
l l 


(5-37) 
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When the input SNR is high, the SNR is not degraded by the mixer. However, 
when the SNR is low (less than 0 dB), the SNR is degraded considerably. In 
such cases, the output SNR is approximately twice the input SNR in decibels. 
For example, a -10-dB input SNR results in a -20-dB output SNR. 


5.4 LINK ANALYSIS FOR NONLINEAR REFLECTOR 


The signal-and-noise power relationships derived in the previous section 
are now used to derive communication-link equations for the nonlinear reflec- 
tor. 


Analysis 


A simplified system model is shown in Figure 5-4. The active-spacecraft 
transponder transmits two signals with power P gt and P et2 » The power re- 
ceived at the passive-spacecraft transponder from the first signal is 


P = G. c P B . /l , 

s**l t\ rj sti pi 

where the "path loss" (more correctly, the effect of capture area) is 


(5-38) 


L pi = ( 4*) 2 P 2 /* 2 • ( 5 - 39 ) 

Since hemispherical but otherwise nondi rectional antenna coverage is antici- 
pated. 


C tl *<?„!* 2 . (5-40) 

The thermal noise corrupting reception of signal #1 in the passive- 
spacecraft transponder is 


P * k T B i F , (5-41) 

where B^ is the bandwidth and F ^ is the noise figure. The signal -to-noi se 

ratio (SNR) for reception of signal #1 at the passive-spacecraft transponder 
is therefore 


R 

1 


= P 

8T»1 



(5-42) 


Analogous relationships hold for the second signal transmitted by the 
active-spacecraft transponder. Since the frequencies and power levels of the 
two signals should be similar, their SNRs should also be similar, hence the 
SNR at the output of the passive-spacecraft transponder is given by (5-36): 

R 2 

R = 1 — . (5-43) 

0 1 + R 

1 
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Figure 5-4. Signal and noise power in polarized interferometer 




The signal and noise powers reradiated by the passi ve-spacecraft trans- 
ponder can be found from (5-29) and (5-35), thus 

? «* 3 ■ » P *V 2 (5 - 44) 

and 

P »t 3 * C p < 2 P A, * % W 2) * (5 ’ 45) 

The reradiated powers captured by the active-spacecraft transponder are then 


P - G. G Pj.lL 
ev3 t 3 r 3 et/ p 3 

and 


(5-46) 


P = G . G Pj.lL , 
nr 3 t 3 vi nt 3 ' p 3 * 

where return path loss L is calculated by analogy to (5-39). 

P 3 

SNR of the returned signal is therefore 


(5-47) 
The resultant 


R = 


g* 3 

P + P 
nr » 3 n 3 


(5-48) 


where P is the thermal noise in the acti ve-spacecraft transponder. 


Forward -Link Design 

Equations (5-38) - (5-43) can be used to analyze the performance of the 
forward communication link. Selected plots of SNR versus distance are shown 
in Figure 5-5. All three curves are based upon forward-path frequencies of 
20 GHz, a return-path frequency of 2 GHz, and 3-dB noise factors. 

The first (lowest) curve in Figure 5-5 is for P g ^ = 1 W and 5^ = 10 

MHz; these parameters correspond to wideband PN modulation and a practical 
power level for continuous transmission. Unfortunately, the SNR of the re- 
radiated signal becomes negative at a distance of less than 10 km. There- 
fore, this combination of modulation and power level is suitable only for 
relatively short distances (e.g., < 1 km). 

The second (middle) curve shows the effect of decreasing the PN chipping 
frequency by a factor of 10 (so B = 1 MHz) and increasing transmitted power 

to 10 W. This combination* should be suitable for distances in excess of 10 
km, but is not adequate for distances of 100 km. The 10-W power level is 
also somewhat high for continuous transmission at 20 GHz. 

To achieve a satisfactory reradiated SNR (P ) at a distance of 100 km 
with only 1-W transmitted power, it is necessary to reduce bandwidth to 1 
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kHz (third curve in Figure 5-5). This can be accomplished by using multitone 
modulation and a 1-kHz tracking bandwidth. 


Return-Link Design 

For - 1 kHz and = 1 W, simple mixing with =* 0 dB in the 

passive-spacecraft transponder produces returned SNRs ranging from -60 dB to 
-240 dB. Since these figures are based upon a 1-Hz detection bandwidth, the 
real-world situation may be even worse by 10 or 20 dB. Obviously, gain in 
the passive-spacecraft transponder is required and truely passive operation 
is not possible. Note that this situation is worse than that of conventional 
radar, since the mixing multiplies two already small power levels to get an 
even smaller power level. 

Figure 5-6 shows the return SNR R as a function of distance for several 

3 

passive-spacecraft transponder gains. Note that the total gain G can be ac- 
complished by adding gain G p 1/2 to both input channels in the passive-space- 
craft transponder. From the curves in Figure 5-6, it is apparent that total 
gains of 140 dB, 200 dB, and 260 dB are required for operation at distances 
of 1, 10, and 100 km, respectively. 


Concl usions 


The forward-link calculations show that it is possible to illuminate 
the passive-spacecraft transponder with signal levels high enough to produce 
a positive reradiated SNR. While wideband PN modulation can be used at short 
distances (< 1 km), narrowband multitone modulation must be used for opera- 
tion at distances of 100 km. 

Considerable gain in the passive-spacecraft transponder is necessary to 
return adequate signal levels to the active-spacecraft transponder. The gain 
required (70 dB to 130 dB per channel) is not prohibitive, but is large 
enough to necessitate careful design. 

The large reception bandwidth at the passive-spacecraft transponder and 
the high gain may make it possible for the system to be "captured" by a 
strong interfering signal. In any case, it is obvious that a simple passive 
or nearly passive system is not practical except for use at relatively short 
distances. 


5.5 LINK ANALYSIS FOR SIMPLE REPEATER 


The relationships developed in the previous two sections are used to de- 
rive preliminary communication-link designs for the simple repeater of Figure 
5-1. Since the local oscillator has an inherently high SNR, the required 
gain is considerably less than that required by the nonlinear reflector. 
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Analysis 

Most of the link equations are Identical to those for the nonlinear re- 
flector (Section 5.4). However, since frequency translation is accomplished 
by mixing the received signal with an essentially noise-free signal from a 
local oscillator, the reradiated signal and noise power are 



P , • G P 

at 3 p sri 

(5-49) 

and 


P„* * P„ . 

nt 3 p n\ 

(5-50) 

The input and output 

SNRs of the passive-spacecraft transponder 

are therefore 

identical ; i .e. , 


R * R . 
0 1 

(5-51) 


Link Designs 

The variation of SNR with distance for a 20-GHz, 1-W forward signal and 
a 2-GHz return signal is shown in Figure 5-7. Operation at a distance of 100 
km is possible. Since the frequencies are the same as those used in the link 
designs for the nonlinear reflectors, it is not suprisir.q that the link per- 
formance is similar. 

With the simple-repeater system, there is no special need to use a tor- 
ward-signal frequency in the 20-GHz range. If the frequency is lowered to 
3 GHz, and path loss is decreased. In addition, Doppler shifts are reduced, 
hence the bandwidth of the input to the passive-spacecraft transponder can be 
decreased to 100 Hz. As a result, satisfactory performance (Figure 5-8) at 
distances of up to 100 km can be achieved with a radiated power of only 100 
mW. 


It is desirable to apply wideband PN modulation to the forward signal 
to facilitate ranging. Since the active-spacecraft transponder acquires nd 
tracks the PN modulation, the 100-Hz tracking bandwidth applies. However, 
unless the passive-spacecraft transponder is equipped with a correlator or 
matched filter, a larger bandwidth must be used at its input. Figure 5-9 
presents the SNR for a system employing a 1-MHz forward bandwidth and a 1-W 
radiated power. It is apparent that operation beyond 10-km is not possible 
unless the radiated power is increased substantially. 
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CHAPTER 6 


TRANSPONDER CONFIGURATION 


The analysis presented in the previous chapter shows that the simple- 
repeater and nonlinear-reflector concepts are unsuitable for the passive- 
spacecraft transponder unless operation is restricted to relatively short 
distances. A more conventional transponder is therefore required. However, 
it need not be as sophisticated or as complex as the transponder on the ac- 
tive spacecraft, since measurements are not required by the passive space- 
craft. 

The three key issues in establishing the transponder configuration are: 

• Frequency assignments, 

• Modulation and format, and 

• Type of antenna. 

This chapter addresses these issues and derives a suitable transponder con- 
figuration. 


6.1 FREQUENCY SELECTION 


The principal issues in selecting frequencies for the forward and re- 
verse links are: 

• Avoidance of frequencies used by STS and other spacecraft, 

• Adequate separation of the forward and return signals, 

• Adequate bandwidth for the desired modulation, and 

• Minimization of passive-spacecraft radiated power. 

The fourth requirement results from the use of omnidirectional, fixed anten- 
nas, and implies the use of as low a frequency as is consistant with the 
other requirements. 

The STS (shuttle) uses S-band (1.7 - 2.3 GHz) for a variety of purposes, 
including direct ground links, TDRSS links, and payload links [Carrier, 1978; 
Bacinski, 1978; Cager, 1978], It also uses Ku-band (13.775 - 14.0 and 14.85 
- 15.15 GHz) for radar and two-way links to the TDRSS. 

The NAVSTAR/G1 obal Positioning System (GPS) is a satellite-based radio- 
navigation system that may be used to determine the absolute position and 
attitude of the active spacecraft. The GPS employs PN-modulated signals (10- 
MHz bandwidth) at 1.2276 and 1.57542 GHz [Milliken, 1980]. 

The frequencies used by the STS, TDRSS, and GPS must be avoided. How- 
ever, these frequencies occupy only a small fraction of the spectrum, hence 
avoiding them should present no problems. Transmission just above the 2- 
GHz band used by the STS should provide adequate bandwidth and require rela- 
tively little radiated power. 


62 



6.2 MODULATION 


The modulation technique used in the polarized-interferometer system 
must allow accurate and unambiguous measurement of range. Suitable modula- 
tion techniques are: 

• Pulse, 

• Multiple-carrier CW, and 

• Pseudonoise (PN). 

Multicarrier CW and PN modulation allow continuous or nearly continuous 
transmission. This keeps the peak power relatively close to the average 
power, thereby minimizing the requirements for the passive-spacecraft trans- 
mitter circuitry. In contrast, pulse modulation requires quite high peak 
transmitter power and is therefore undesirable. 

Pseudonoise modulation [Dixon, 1976] is desirable because it rejects in- 
terference and allows precise and unambiguous tracking. However, it requires 
more signal -processing circuitry than is required for multicarrier CW. 

In light of the above-mentioned constraints upon the modulation, four 
candidate transponder configurations were developed, namely: 

• Multiple-carrier CW repeater, 

• Coherent PN transponder, 

• SAW/clipper PN transponder, and 

• SAW/CCD PN transponder. 

The subsequent discussion in this section compares these four approaches. 


Mul ticarrier-CW Repeater 

The multiple-carrier CW repeater is a relatively simple system that is 
not unlike the systems commonly used for VHF/UHF FM land-mobile communica- 
tion. As shown in Figure 6-1, it comprises amplifiers, filters, and mixers, 
as well as an FM detector, squelch circuit, and microprocessor. Link analy- 
sis (Chapter 5) shows such systems to be practical for distances up to 100 
km. 


Transmissions from the active spacecraft are made sequentially on a num- 
ber of different frequencies to provide both range accuracy and range-ambigu- 
ity resolution. For operation at relatively short distances, a wideband re- 
peater (Figure 5-1) can be used. However, a relatively large bandwidth de- 
grades the SNR and allows the repeater to be captured by an interfering sig- 
nal. For long-range operation, it is therefore desirable that the repeater 
use narrowband filtering (e.g., 100-Hz bandwidth) and establish synchroniza- 
tion with the signals from the active-spacecraft transponder. 

The microprocessor scans through the pre-determined set of frequencies 
until a signal is detected (by a quiet output of the FM detector). Upon de- 
tecting a signal, the microprocessor attempts to establish synchronization by 
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Figure 6-1. Multiple-carrier CW transponder. 







selecting the next transmission frequency at the appropriate time. Once syn- 
chronization is established, dithering is used to establish precise synchro- 
nization and the transmitter is activated. If synchronization is not estab- 
lished, scanning is resumed. Time or frequency division can be used to mul- 
tiplex transmissions from the four elements of the passive-spacecraft trans- 
ponder. 

The local oscillator in the passive-spacecraft transponder introduces 
an unknown frequency offset in the returned signals. However, all signals 
returned to the active-spacecraft transponder are offset by the same amount. 
Differencing the frequencies of the signals received at the active-spacecraft 
transponder therefore provides the Doppler shift without corruption by the 
local oscillator in the passive-spacecraft transponder. 


Coherent Pseudonoise Transponder 

Pseudonoise (PN) modulation is desirable because it allows both precise 
and unambiguous range measurement. However, the large bandwidth required by 
a PN-modulated signal precludes the use of a simple repeater except at short 
distances. 

The "conventional" PN transponder shown in Figure 6-2 is based upon 
correlation techniques. Coherent detection produces I and Q baseband sig- 
nals, which are used by the microprocessor to establish frequency, code, and 
phase lock to the received signal. 

Upon completion of signal acquisition, the transmitter is activated and 
returns a signal that is modulated by its own unique PN code. The carrier 
frequency, carrier phase, and code phase of the returned signal are locked 
to those of the received signal. Different PN codes are used to allow simul 
taneous transmissions from all four elements of the passi ve-spacecraft trans 
ponder. 

This system is well suited to this application, as it provides a good 
return SNR and good rejection of interfering signals. While it is more com- 
plex than a CW/multitone repeater, it is not as complicated as a navigation 
receiver, since estimates of time of arrival and position are not required. 
The increasing use of the NAVSTAR/GPS radio-navigation system may make such 
technology commonplace a few years hence. 


SAW Pseudonoise Transponder 

Surface-acoustic-wave (SAW) devices can be used to implement matched 
filters for PN-modulated signals. A PN transponder based upon SAW technology 
may be somewhat simpler than the coherent transponder described above. 

Figure 6-3 presents a block diagram of a PN transponder based upon SAW 
matched filters. The received si^al is downconverted to VHF for processing 
by the SAW filter. The first SAW filter converts the PN signal (1) into a 
rectangular CW pulse (2). 

A pulse detector with AGC (3) gates the output (4) of the SAW filter to 
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Figure 6-3. SAW-PN transponder. 










the subsequent circuitry only when ’a CW pulse is detected. The gating effec- 
tively eliminates the noise power when the CW pulse is absent, and therefore 
increases the SNR as does a narrowband filter. The gated CW pulse (5) is ap- 
plied to a second SAW filter to generate a return signal (6) with unique PN 
modulation. Optionally, the pulsed CW signal can be retransmitted directly; 
however, the transmitter must then have a considerably larger peak-power 
capability. 

As shown in Figure 6-3, the system Introduces an unknown and undetermi- 
nable frequency error due to the local -oscil lator offset. One solution to 
this problem is to transmit sequentially on two different frequencies; the 
offset can then be derived at the active spacecraft by measuring the frequen- 
cies of the received signals and differencing the results. Alternatively, 
the active-spacecraft transponder can transmit on two different frequencies 
and the passive-spacecraft transponder can apply exactly the same frequency 
change to each. The Doppler shift can then be determined by frequency dif- 
ference between the two returned signals. 


SAW/CCD Pseudonoise Transponder 

The principal problem in the SAW transponder discussed above is jitter 
in the timing of the returned signal. This jitter is caused by gate-timing 
jitter, which is in turn caused by noise corrupting the CW pulse. The SAW/ 
CCD system of Figure 6-4 reduces the timing jitter by averaging successive 
pulses. 

The downconverted PN signal (1) is applied to the first SAW filter to 
obtain a CW pulse (2), as in the previous SAW transponder. The CW pulse is 
applied to a noncoherent amplitude detector to obtain a baseband pulse (3); 
SNR is not degraded significantly if the CW pulse has positive SNR at the 
input of the detector. The CCD array averages the baseband pulses to reduce 
the effective detection bandwidth to the 1- to 10-Hz range. The averaged 
pulses (4) are then clipped to remove the inter-pulse noise. The clipped 
pulses (5) then modulate a locally generated RF signal to produce CW pulses 
(6), which in turn drive the second SAW filter to produce the PN-modulated 
return signal (7). 


Conclusions 


The SAW/clipper transponder may not deliver the desired performance ex- 
cept at high SNRs. The SAW/CCD transponder appears promising, but exceeds or 
at least taxes the current states of the art for both SAW and CCD technolo- 
gies. Implementation of such a transponder therefore cannot be recommended 
at the present time. However, such a system may become feasible in the not- 
to-distant future. 

The multiple-carrier CW and coherent PN transponders are readily imple- 
mented using current technology. The coherent PN transponder is considerably 
more complex than the multiple-carrier CW transponder, and the power consump- 
tion of its code generator may exceed that of its RF power amplifiers. In 
the absence of interference, the performances of the two systems are essen- 
tially the same. Therefore, the less complex multiple-carrier CW technique 
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Figure 6-4. SAW 





is preferred for applications without requirements for security or resis- 
tance. 


6.3 ANTENNAS 


The polari zed-interferometer antenna array on the active spacecraft must 

• Transmit circularly polarized signals, 

• Receive circularly polarized signals, and 

• Receive linearly polarized signals. 

Similarly, the array on the passive spacecraft must 

• Receive circularly polarized signals, 

• Transmit circularly polarized signals, and 

• Transmit iinearly polarized signals. 

Such arrays are most easily implemented by using two linearly polarized ele- 
ments in each of the four components shown in Figure 1-3. Phasing is used 
to obtain circular polarization when and where it is needed. 

Suitable antenna components are 

• Crossed dipoles, 

• Crossed slots, and 

• Horns. 

The most stringent requirement is imposed by the necessity to measure signal 
amplitude with an error of 0.1 dB or less. The relevant characteristics of 
each type of component are discussed in this section. 


Crossed dipole 

The crossed dipole can be implemented in a number of forms, as shown in 
Figure 6-5. Normally, the elements are straight and parallel to the ground 
plane. However, if space is at a premium, the elements can be bent downward, 
effectively producing a loaded short dipole. The elements can be mounted on 
a strut or can be printed on low-dielectric material (PCB). The later type 
of construction is desirable because of its high rigidity. 

The patterns of full-length and electrically short dipoles differ. In 
addition, the pattern of a dipole in free space differs from the pattern of 
a dipole above a ground plane. 


Crossed Slot 

The crossed-slot antenna is implemented by cutting slots in a conducting 
surface (Figure 6-6). Matching circuitry can be implemented on a printed- 
circuit board immediately behind the slots. 
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Figure 6-5. Crossed dipoles. 
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i Figure 6-6. Crossed slot. 
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The crossed slot Is Inherently rigid and rugged, and does not protrude 
from the surface. Its pattern Is similar to that of a crossed dipole above 
a ground plane. 


Horn 


The rectangular ("quao-rldge") horn antenna (Figure 6-7) is also capable 
of producing either linear polarization when proper excitation Is provided. 
Such antennas (e.g., Sanders CA series) are capable of operation over more 
than an octave In frequency. In addition, they are inherently rugged and 
stable. 

The pattern of the horn antenna is probably affected less by Its sur- 
roundings than are the patterns of crossed dipoles or crossed slots. How- 
ever, the half-power beamwldth of the horn antenna Is limited to a maximum of 
about 20° to 30°. 


Comparl son 

If the cone of operation were limited to 20° or 30° off boreslght, the 
horn antenna would be preferable. However, in the present application, a 
wide cone of operation (45° off boreslght) is desired, hence the horn is not 
suitable. 

Both the crossed dipole and the crossed slot are suitable. The choice 
depends primarily upon the required antenna form factor. If antenna height 
is not important, the crossed dipole is preferred. However, if the antenna 
must be stowed and deployed, antenna height may be a significant considera- 
tion. In this case, the crossed slot is preferred. 


Instal lation and Accuracy 

Repeatable pattern accuracies of 0.2 dB are readily achieved in a labo- 
ratory environment. However, installation over an irregular and/or finite 
ground plane can produce pattern ripple of 1 dB or more. Radomes can also 
introduce significant pattern distortion. Fortunately, they are not needed 
in this application. 

The pattern ripple associated with the installation can be minimized by 
two techniques. First, the antennas should be mounted on a large, flat disk. 
This reduces the effects of finite size and curvature of the ground plane. 
Second, the antenna/ground-plane array should be mounted on a strut away from 
the spacecraft. This should be possible in an airless environment with 
slowly maneuvering spacecraft. 

The 0.06-dB pattern-ripple requirement (Chapter 8) is fairly stringent 
and pushes the state of the art. However, similar requirements exist in new 
direction-finding systems for EW applications. The recently developed 
scalar-horn system ["NBS", 1982] achieves an amplitude accuracy of ±0.1 dB in 
its 4-to-7 GHz band of operation. 
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With calibration, It should be possible to meet the desired 0.06-dB er 
ror requirement, especially near the center of the field of view. In fact, 
the antenna design may be considerably less difficult if the cone of opera- 
tion can be divided Into two regions, with the minimum ripple required only 
In the center. 
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CHAPTER 7 


MULTIPLE-CARRIER CW RANGING 


Multiple-carrier CW ranging Is of Interest In the polarized-interfer- 
ometer application because It requires the least complicated transponder on 
the passive spacecraft. In this approach, a number of CW carriers of differ- 
ent frequencies (Figure 7-1) are transmitted from the active spacecraft and 
returned (wich known frequency offset) by the transponder on the passive 
spacecraft. This chapter analyzes multiple-carrier ranging with respect to 
two key aspects: 

• Range accuracy 

• Cycle-ambiguity resolution. 

The resultant equations are used in the system design (Chapter 8). 

The polarlzed-lnterferometer system uses sequential transmission on each 
frequency. The duration of the transmission on a given frequency is In the 
range of 0.1 to 0.5 s to enable a simple FM squelch circuit In the passive- 
spacecraft transponder to acquire the transmission pattern. The set of K 
different frequencies are arranged such that 

/ * /, + v / 

2 1 0 


J K 



+ 


/-> 


f 


0 


(7-1) 


where f is the minimum difference frequency and v is tne number of cycles 
o 

to be resolved at each step in the ambiguity-resolution process. 


7.1 RANGE ACCURACY 


The polari zed-interferometer system employs two-way transmissions. the 
total phase error in the signal returned to the active spacecraft is there- 
fore the sum of the phase errors in both the forward and reverse paths; i.e., 

. (7*2) 

The phase variance caused by Gaussian noise is given by the well-known rela- 
tionship 
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(7-3) 
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where Ft is the signal -to-noise power ratio (SNR). 

Since the noises in the forward and reverse channels are independent, 
the total -noise variance is 



(7-4) 


where P R and r r represent the SNRs of the forward and reverse channels, re- 
spectively. If E p = R R , then 



Otherwise, the total-noise variance is determined principally by the smaller 
of the two SNRs. 


The variation of phase with distance is determined by the wavelength 
(hence frequency) of the carrier, thus 



Since the phase of the returned signal is the sum of the phase shifts in both 
the forward and reverse links, 

~ ^F + ^R ^F P F + ^ R P R ^ ' (^“^) 

<3 

At large distances, p„ = p D , and (7-7) simplifies to 

i. 

2 *f T 

♦ r (P f + P R ) = q T P (7-8) 

c 

where 

f T • (j> * f „)/ 2 . (7-9) 

and 

p s P F + P R = 2 P F = 2 P R (7-10) 

is the total two-way path length. 

If f R * f F (as in a repeater) or p f * p R (at short distances), p cannot 

be recovered from the phase of a single carrier frequency. However, p can be 
recovered from the difference between the phases of two carriers, as discuss- 
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ed in the next section. 

Given correct cycle resolution and s p Rt the range estimate is de 
rived from the phase measurement by 


p = , (7-11) 

2-rr f T 

where c represents the speed of light. The variance of the range estimate 
is therefore 






(7-12) 


All K carriers are of approximately tne same frequency and same SNR and 
therefore can oe used to derive K independent estimates of the same accuracy. 
Averaging of these K estimates reduces the variance shown in (7-11) by the fac- 
tor 1/K. However, reducing the duration of the transmissions to allow trans- 
missions on additional frequencies decreases the averaging done by the phase 
detectors. This in turn increases the variance in (7-11), causing the variance 
of the average of the individual estimates to remain unchanged. Assuming 
that ambiguities are resolved correctly, the number of carrier frequencies 
does not affect range accuracy. 


7.2 AMBIGUITY RESOLUTION 


The phase of a returned carrier goes through one cycle of 2 tt radians 
every tine range p changes by 

K - df T - 2 e /{f F + f R ) (7-13) 

The equivalent wavelength X is the maximum unambiguous range-measurement in- 
terval. Decreasing the carrier frequencies increases the unambiguous range- 
measurement interval. However, lower limits on the carrier frequency are im- 
posed by both antenna size and frequency allocations. 

A greater unambiguous range interval can be obtained by using the dif- 
ference between the phases of two carriers. For example. 


where 
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2 > 1 
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and 


(7-14) 

(7-15) 
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(7-16) 


^,1 = ^V 2 * f R 2 " W?1 + -^Bi )]/2 

is the difference between the two carrier frequencies. By analogy to (7-11), 
the ambiguity interval is 


x 

2*1 



(7-17) 


The maximum ambiguity interval is related to the minimum difference frequen- 
cy, hence from (7-1) and (7-15), 


X 


max 



(7-18) 


The derived phase measurement corresponding to the smallest frequency 
difference provides the least ambiguous but also the least accurate range es- 
timate. The carrier phase measurements provide the most accurate but also 
the most ambiguous measurements. The estimate derived from the lowest dif- 
ference frequency is therefore used only to resolve the ambiguity in the es- 
timate derived * r om the second-lowest difference frequency (Figure 7-2). The 
estimate derived from the second-lowest difference frequency is similarly 
used to resolve the ambiguity in the estimate derived from the third-lowest 
difference frequency. This process continues until the ambiguity in the car- 
rier phase is resolved. 


Implementation 

Ambiguity resolution is implemented by finding the best match between 
range estimate derived from two different frequencies. From inspection of 
(7-12), the range estimate corresponding to f is 


P 

2 > 1 




(7-19) 


and is assumed to be unambiguous over the interval of interest. The phase 
difference corresponding to carrier frequencies / and f is by analogy to 

(7-12) 


<|| = <t>m - = q P . (7-20) 

3.1 T l T \ 3.1 

The range estimate derived from this phase difference is then 

P * (♦ + 2’ l)/?, , . (7-21) 

3.1 3.1 3*1 

where l represents the cycle number. (In radio-navigation systems, l is 
often called the lane number). 


The cycle number is found by equating the two range estimates 
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( 7 - 22 ) 


which yields 


Since 


P 3»i P 2»i ’ 
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(7-23) 


(7-24) 


the estimated lane number is simply 



(v 




(7-25) 


Note that (7-23) applies to any step in the ambiguity resolution process. 


Error Analysis 

Because the phase estimates used in (7-23) contain noise-induced errors, 
the estimated cycle number must be rounded to the nearest integer. If the 
total error in the two phase estimates is large enough, l is rounded to the 
wrong, integer value and an ambiguity error occurs. 

The error in determining the unrounded cycle number is related to in- 
dividual phase errors by analogy to (7-23), (7-18), and (7-12), thus 


' 2, ^ ^2,1 ‘ E 03.1 ] 

(7-26) 

iv(c r z * ■ (e r 3 - £ n> 1 

(7-27) 

= i [(! - v) t Ti * v E j, 2 - e rj ] . 

(7-28) 


If the variances of all carrier phase estimates are equal, then (7-26) re- 
duces to 


= (l/2ir) 2 [(l - v) 2 + v 2 + 1] a 2 

l * 


r-29) 


The use of (7-5) reduces this to 
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(7-30) 


2 _ v 2 - V + 1 

Z * 

l 2 * 2 R 

where R is the signal -to-noi se ratio of each individual link. 


Probabil ity of Error 

A cycle-resolution error occurs when 

\l\ > 1/2 . (7-31) 

For Gaussian noise, 

P[ | 2 | < L] = erf (£/2 1/2 aj) . (7-32) 

The probability of a cycle-resolution error is therefore given by 

P ei ■ 1 - erf (l/2 3/2 of) . (7-33) 

The probability of a cycle-resolution error is shown in Table 7-1 and 
Figure 7-3. It is apparent that cycle ambiguity resolution is readily accom- 
plished when the interval ratio is small. 

A cycle-resolution error can occur at any step of the ambiguity-resolu- 
tion process. If there are K carrier frequencies, K-l steps are required, 
and 

P eT = (^ " ^ P e i ’ 

assuming p g << 1 (which is required for any practical system). 


(7-34) 


Probability of error 
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CHAPTER 8 


SYSTEM DESIGN 


Multiple-carrier CW ranging has been Identified as the preferred signal 
format for present-day Implementation of a polarlzed-interferometer system. 
The dependence of accuracy and cycle-ambiguity-error probability upon SNR Is 
determined in the previous chapter. These relationships and the requirements 
from Chapter 2 are now used to develope a suitable system design. This de- 
sign Is then verified by simulation. 


Requirements 

The accuracy requirements (Table 1-1) affecting the system design are: 

• Range accuracy (3o): One percent of range, 

• Direction-finding accuracy (3o): 10 mrad 5 0.57°, and 

• Roll accuracy (3o): 30 mrad 2 1 7°. 

Operation at distances up to 100 km may be required. To allow stand- 
alone operation, two-way range ambiguities of up to 200 km must be resolved, 
hence 


f = 2 = 1.5 kHz . (8-1) 

2-100 km 

To prevent noise from causing ambiguity-resolution errors at minimum and max- 
imum range, f must be smaller than f . . To achieve approximately the same 
0 " 

probability of ambiguity-resolution error as in the other steps, it is neces- 
sary to reduce f to 
0 


f „ ■ — - — f, • (8-2) 

0 V + 1 * 

If v = 6 is assumed, then f = 1250 Hz is satisfactory. 

0 

Since a cycle-ambiguity error produces significant range and direction- 
finding (DF) errors, a very low probability of error is cesirable. For this 
design, p &T - 0.001 is assumed. 

Minimization of the power that must be radiated from the passive-space- 
craft transponder is also an important consideration. 
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Candidate Approaches 

Candidate approaches can be divided into two categories: 

• Carrier-frequency tracking (CFT), and 

• Difference-frequency tracking (DFT). 

The CFT system derives range from carrier phase, while the DFT system derives 
range from the phase of a difference-frequency signal. Both systems utilize 
a number of CW signals to provide ambiguity resolution. 

The CFT system obtains the same range accuracy with a lower SNR, since 
only two signals (forward and reverse) are involved, and the wavelength of 
the carrier is quite short. However, both SNR and hardware-induced phase 
biases limit the cycle -resolution ratio, hence the CFT system requires a 
relativly large maximum difference frequency (/^ - f^). The candidate de- 
sign discussed here uses f F = 3 GHz and = 2 GHz (Figure 8-la). Assum- 
ing that the cycle-resolution ratio v = 6, the maximum difference frequency 
is 420 MHz. 

The DFT system requires a higher SNR. However, the smaller maximum dif- 
ference frequency allows a smaller antenna bandwidth. The candidate design 
discussed here uses a maximum difference frequency of 100 MHz. It can there- 
fore use somewhat lower carrier frequencies such as f F » 2.4 GHz and = 

1.6 GHz (Figure 8-lb). 

Excitation of the antenna elements is most readily accomplished by using 
individual power amplifiers dedicated to each element. Simultaneous retrans- 
mission with frequency-division multiplexing is therefore preferred. As 
shown in Figure 8-2, the active-spacecraft transponder transmits sequential- 
ly on each of nine different frequencies. During each of the corresponding 
nine time slots, all four elements of the passive-spacecraft array retrans- 
mit on slightly different frequencies. A total of thirty-six different fre- 
quencies are therefore allocated to the return transmissions. This technique 
adds no complexity and, in fact, minimizes the peak power in the passive- 
spacecraft transponder. 


8.1 CARRIER-FREQUENCY TRACKING 


Range-Accuracy Requi rement 

The minimum operating range determines the range-uccuracy requirement. 

For operation at a distance of 1 m, the 3o accuracy is 1 cm, hence the 
standard deviation (rms) of the range estimate is 

o- = Ml = 0.0033 . (8-3) 

P , 
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The variances of the range estimate p and the range measurements y ^ are re- 
lated by (4-20), thus 

o* a 0.278 o 2 (8-4) 

p y 

and 


o ■ 0.1095 m ■ 10.95 cm . (8-5) 

y 

This requirement turns out not to be the most stringent and therefore does 
not drive the system design. 


OF-Accuracy Requirement 

The requirement for a 2o direction-angle accuracy of 10 mrad implies an 
rms angular error of 3.33 mrad or 0.19i°. From (4-21), 


(0.0333) 2 » V 


0.4448 o 2 

y 


2 COS 2 8 


(P-6) 


max 


where 8„. is the maximum off-boresight angle. To allow operations within a 
max 

45° cone, 8 mav * 45° and 
max 



o * 0.00353 m * 3.53 mm . 

y 

(8-7) 

For the candidate CFT system. 



ft, * I*/, * V /2 ’ 2 ' 5 GHz 1 

(8-8) 

hence 

Xj, * 3 • 1 0 8 //* * 0.120 m * 12.0 cm . 

(8-9) 

Now from (7-12), 

t 

o * (2 tt/A_) a, * 0.185 rad * 10.6° . 

(8-10) 

The required 

SNR Is now determined by using (7-5): 



R f « R r * l/o 2 - 29.22 - 14.7 dB . 

(8-11) 


Obviously, this requirement is met by any system capable of achieving phase 
lock. 


Roll -Accuracy Requirements 

Inspection of Figure 4-4 shows that V < 2 for off-boresight 

U 

angles of up to 45°. The 30-mrad 3a roll -accuracy requirement implies an 
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rms roll error of 10 mrad (0.57°). Therefore, the normalized rms noise am- 
plitude is 


°a “ /2W2 = °* 00707 * (8—1.2) 

The corresponding SNR is 

R d * 1/(2 a 2 ) = 10 4 - 40 dB , (8-13) 

n Q. 

and the corresponding gain error is 

z G = 20 log (1.00707) = 0.061 dB . (8-14) 

Ambiguity-Resolution Requirements 

The SNR required for a given probability of cycle-ambiguity-resolution 
error can be obtained by iterative application of (7-31). The results for 
the two design examples are presented in Table 8-1. 

It is apparent from Table 8-1 that the transmission on nine different RF 
carrier frequencies requires six phase cycles to be resolved in each step of 
the ambiguity-resolution process. For p gT < 0.001, p g ^ = 0.001/9 = 0.00011, 

hence R > 19.1 dB. The nine carrier frequencies range from 2.0 GHz to ap- 
proximately 2.42 GHz. 

Ambiguity-resolution errors can also arise from unknown hardware phase 
shifts. If <j> represents the maximum unknown hardware phase shift, then 

iTiaX 


A4> + — A<b 

max y max 



For this example. 


A* < -1551 = 25.7° 
max v ♦ 1 


(8-15) 


(8-16) 


which is much less stringent than the requirement imposed by DF accuracy. 


Link Design 

The SNR at the receiver is given by 

R - P * G r . (8-17) 

P L 
n p 

where ? t represents the radiated power and G t and G v represent the transmit- 
ting and receiving antenna gains, respectively. The receiver thermal -noise 
power is given by 


a- 
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K 

^ ei 

CARRIER-FREQUENCY 

TRACKING 

DIFFERENCE-FREQUENCY 

TRACKING 


R . , dB 
min* 

V 

^min* 

2 

.0010000 

1666668.000 

110.0 

66666.633 

102.9 

3 

.0005000 

1290.995 

66.1 

258.199 

55.1 

4 

.0003333 

118.563 

45.6 

40.548 

39.2 

5 

.0002500 

35.930 

35.3 

16.069 

31.2 

6 

.0002000 

17.554 

29.1 

9.221 

26.3 

7 

.0001667 

10.889 

24.9 

6.368 

23.1 

8 

.0001429 

7.742 

21.9 

4.888 

20.7 

9 

.0001250 

5.994 

19.7 

4.009 

18.9 

10 

.0001111 

4.913 

17.9 

3.435 

17.5 

11 

.0001000 

4.190 

16.4 

3.037 

16.4 

12 

.0000909 

3.678 

15.3 

2.745 

15.6 

13 

.0000833 

3.300 

14.3 

2.523 

14.8 

14 

.0000769 

3.010 

13.5 

2.350 

14.2 

15 

.0000714 

2.782 

12.8 

2.211 

13.7 

16 

.0000667 

2.599 

12.2 

2.097 

13.3 

17 

.0000625 

2.448 

11.7 

2.002 

13.0 

18 

.0000588 

2.323 

11.3 

1.922 

13.0 

19 

.0000556 

2.216 

10.9 

1.854 

13.0 

20 

.0000526 

2.126 

10.5 

1.794 

13.0 

21 

.0000500 

2.047 

10.2 

1.743 

13.0 

22 

.0000476 

1.978 

10.0 

1.697 

13.0 

23 

.0000455 

1.918 

10.0 

1.657 

13.0 

24 

.0000435 

1.864 

10.0 

1.621 

13.0 

25 

.0000417 

1.817 

10.0 

1.589 

13.0 


Table 8-1. Ambiguity-resolution requirements for two example system designs. 
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P n --k B TB F 


(8-18) 


where k_, r, B, and P represent* respectively, Boltznan's constant (1.38* 

D 

10" 23 ), temperature (°K), bandwidth (Hz), and noise figure. The path loss is 
given by 

L p - (4w) 2 p 2 /X 2 . (8-19) 

In the present application, hemispherical antenna coverage produces G t * 

G = 3 dB. A noise figure of 10 dB or better is readily achievable at the 

frequencies of interest. The required SNR can then be determined by manipu- 
lation of (8-17) - (8-19). 

The greatest SNR requirement is imposed by the roll -angle accuracy spec- 
ification. To obtain the required 40-dB SNR at a distance of 100 km requires 
the active-spacecraft transponder to radiate 2.13 W and the passive-space- 
craft transponder to radiate 1.07 W (Table 8-2). 

However, roll -angle information is not actually needed until the two 
spacecraft enter the docking phase (Section 1.2). The next-most demanding 
SNR requirement (19.7 dB) is imposed by the ambiguity-resolution specifica- 
tion. To obtain a 20-dB SNR at a distance of 100 km requires forward- and 
reverse-link radiated powers of 21.3 mW and 10.7 mW, respectively (Table 
8-2). With these power levels, SNR increases to 40 dB at a distance of 10 
km, hence the roll-angle accuracy specification can be met at distances of 10 
km or less. 


8.2 DIFFERENCE-FREQUENCY TRACKING 


The design of a DFT system is, in most respects, identical to the design 
of a CFT system. As in the example CFT design discussed previously, the DF 
accuracy specification produces a more stringent range-accuracy requirement 
than does the range-accuracy specification. The roll-angle accuracy specifi- 
cation again requires a 40-dB SNR. 


DF-Accuracy Requirement 

The candidate DFT system design uses a maximum frequency difference of 
100 MHz to reduce antenna-bandwidth requirements. By analogy to (8-8), 
(8-9), and (8-10), 


f T * 100 MHz 


(8-20) 


\ T = 3«10 e // r = 3.0 m 
and 


( 8 - 21 ) 
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SNR 

L POWER ] 

Forward Link 
f p * 3.424 GHz 

Return Link 
f R » 2.424 GHz 

40 dB at 100 km 

2.134 W 

1.069 W 

20 dB at 100 km 
40 dB at 10 km 

21.34 mW 

10.69 mW 


Note: B = 100 Hz, F - 10 dB, G t = G v = 3 dB 


Table 8-2. Power requirements, CFT system. 


SNR 

PO 

rfER 

Forward Link 
f F = 2.5 GHz 

Return Link 
f R = 1.7 GHz 

46 dB at 100 km 

4.540 W 

2.099 W 


Note: B = 100 Hz, F = 10 dB, G. = G = 3 dB 

t v 


Table 8-3. Power requirements, DFT system. 
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( 8 - 22 ) 


= 0.00739 rad = 0.423° . 

9 

The rms phase error in (8-22) is the result of differencing two phase 
measurements. Therefore, the required SNR is obtained by insertion of a fac 
tor of 2 into (8-11) : 


R = R = — = 36621.9 + 45.6 dB 
F R 2 

4 > 


(8-23) 


Ambiguity-Resolution Requirements 


Inspection of Table 8-1 shows that the use of eight different carrier 
frequencies requires resolution of just less than five cycles per step. A 
SNR of 20.7 dB is required. 


Link Design 

A 46-dB SNR is required to meet both the DF accuracy specifications. 
Since the DF accuracy specification must be met at 100 km, the radiated pow 
ers of the forward and reverse links are 4.54 W and 2.10 W, respectively 
(Table 8-3). 


8.3 SIMULATION IMPLEMENTATION 


Approach 

Carrier-frequency tracking requires less power than does difference- 
frequency tracking. Since minimization of the power required by the passive- 
spacecraft transponder is essential, CFT is preferable to OFT. 

However, the MVLE tracking algorithm developed in Chapter 4 requires 
explicit determination of two-way range. In the absence of noise- and hard- 
ware-induced errors, two-way range is determined exactly by difference-fre- 
quency tracking but only approximately by carrier-frequency tracking (7-7). 

The polarized-interferometer simulation is therefore implemented using 
difference-frequency tracking exclusively. The frequency scheme is, however, 
that of the CFT approach discussed in Section 8.1. The requirement for a 
40-dB SNR at 100 km implies P F = 2.2 W and P R - 1.1 W. 


Characteri sties 


The principal characteristics of the simulation system design are: 

• f = 1250 Hz and v * 6.13, 

o 

• Frequency-division multiplexing (Figure 8-2), 
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• Nine forward-link carrier frequencies (3.0 - 3.42 GHz), 

• Nine return-link carrier frequencies for each of four antennas (2.0 
- 2.42 GHz), 

• P p - 2.2 W and P R = 1.1 W, 

• G t = G r = 3 dB and F - 10 dB, 

• Difference-frequency tracking, 

• Nine carrier-amplitude measurements are averaged to obtain each 
amplitude-coupling estimate, 

• Range accuracy to be one percent of range or better, 

• Directional accuracy to be 3.3 mrad (0.2°) rms or better, 

• Roll -angle accuracy to be 10 mrad (0.6°) rms or better when p < 10 
km, 

• Maximum operational distance of 100 km. 


Implementation 


The simulation program is implemented by combining an RF-system simula- 
tion and the minimum-varianc? linear estimator algorithms developed in Chap- 
ter 4. The MVLE for range is replaced by the less complex estimator from the 
initialization algorithm (Chapter 3); this estimator simply averages the nine 
two-way range estimates. The complete simulation program is listed in the 
Appendix. 

The simulation program assumes that SNR is 10 dB or better at all points 
of interest. The effects of noise upon carrier phase and amplitude are 
therefore modelled as independent, additive, Gaussian random variables. The 
SNR and associated random error in the forward and return paths are calcu- 
lated separately. 

The RF subroutine includes an ambiguity-resolution algorithm. The in- 
dividual two-way range estimates are checked for ambiguity-resolution errors 
prior to estimating position and attitude. Ambiguity-resolution errors are 
tallied, and estimation of position and attitude in inhibited if an ambigui- 
ty-resolution error occurs. 


Results 


The results of the simulations are graphed in A Figures 8-3 and 8-4. The 
simulation program determines rms error in range (p), passive-spacecraft 
direction ( 4 » ), active-spacecraft direction ($ ), and relative roll 
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Figure 8-3. 

Simulation error 

vs. range. 









(♦ ). Each test series comprises 100 individual trials. 

The variations of rms errors with range are shown In Figure 8-3. At the 
maximum design range of 100 km, DF and errors do not exceed 1 mrad rms, which 
is well below the design goal of 3.3 mrad rms. All angular errors decrease 
to Insignificant values as distance decreases. Range error does not exceed 1 
mm rms at the maximum 100-km range. The increases in range error at short 
distances are due to a simplification used In the range-estimation algorithm, 
but are nonetheless below the desired one-percent-of-range specification. 

The increase in DF error at very short distances Is due to the Increase in 
the error in the range estimate. 

The variations of rms errors with relative roll are shown in Figure 8-4. 
It is apparent that satisfactorily low values are obtained, and that roll 
does not significantly alter the error sensitivity. 


Conclusions 


The simulation results validate the system design and prove that the 
polari zed-interferometer concept is indeed feasible. Since the rms error is 
in all cases smaller than the design requirement, the candidate design in- 
cludes a margin for protection against additional system errors. 

The algorithm developed to date requires that phase measurements be con- 
verted to two-way range measurements, which are then used to determine range, 
direction angles, and relative-roll angle. Because different frequencies are 
used in the forward and return links (and the receiving and retransmitting 
antennas are at different locations), two-way range cannot be determined ex- 
actly by carrier-frequency tracking. Consequently, difference-frequency 
tracking and the associated higher power levels are used in the simulation. 

Modification of the direction-finding algorithm to use range differences 
instead of two-way ranges will allow the use of carrier-frequency tracking. 

If such an algorithm is implemented, the required radiated power drops from 
2.2 W (forward) and 1.1 W (return) to 42 mW (forward) and 21 mW (return). 

The lower power requirement should be most useful in simplifying the passive- 
spacecraft transponder. The Increase in rms range error at short distances 
can be eliminated by using a true minimum-variance range estimator, rather 
than the approximation used in the simulation program. 
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CHAPTER 9 


CONCLUSIONS AND RECOMMENDATIONS 


The polarized Interferometer Is a radio-frequency system for real-time 
measurement of relative position and attitude. This report presents the re- 
sults of a study of the feasibility of a rendezvous-and-docking sensor based 
upon the polarlzed-interferometer concept. In the anticipated application, 
one spacecraft Is active (maneuverable) while the other spacecraft is pas- 
sive. 


The major accomplishments of this study Include: 

• Development of an algorithm for obtaining Initial position and atti- 
tude estimates without any a priori Information, 

• Development of a tracking algorithm based upon minimum-variance 
linear estimators, 

• Determination of the sensitivity of estimates to measurement errors, 

• Evaluation of concepts for the passive-spacecraft transponder, 

• Establishment of a configuration for the passive-spacecraft trans- 
ponder, and 

• Implementation of a static simulation program. 

The performance requirements used In this study are: 

• Operation at distances up to 100 km, 

• Operation up to 45° off boreslght of either spacecraft, 

• Rms range accuracy (3 o) of one percent of range, 

• Direction accuracy of 10 mrad (3o), and 

• Roll accuracy of 30 mrad (3a) at distances up to 10 km. 

The preferred system configuration uses multiple-carrier CW signals for pre- 
cise and unambiguous range measurement. Frequencies in the 2-3 GHz band 
are used, and the required radiated power is only 20 to 40 mW. Each antenna 
arrays consists of four sets of two crossed dipoles or crossed slots. 

The polarized interferometer is one of several possible techniques that 
can be used in a rendezvous and docking sensor. However, it has several 
potential advantages, including: 

• Measurement of position and attitude, 

• Operation at both long and short ranges, 

• Real-time operation, 

• Stand-alone operation, and 

• Simple, low-power transponder for the passive spacecraft. 

The three principal conclusions of this study are: 
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• The analysis and design equations are correct; 

• The polarized-interferometer is feasible; and 

• The requirements for a rendezvous-and-docking sensor are reasonable. 

A number of details should be resolved before hardware Implementation 
and testing is initiated. Further evaluation Is recommended 1r the following 
three areas: 

• Tracking algorithm, 

• Antenna characteristics, and 

• Dynamic simulation. 

The recommended work and anticipated benefits are discussed below. 

The tracking algorithm developed in Chapter 4 operates upon a set of 
nine two-way range measurements (in addition to four amplitude measurements). 
Since exact two-way range can be determined only from difference-frequency 
measurements, the simulation (Chapter 8) must use difference-frequency track- 
ing and its associated higher power levels (1-2 W). The tracking algorithm 
can be redesigned to use range differences rather than two-way ranges. This 
will allow the use of carrier-frequency tracking and its associated power 
levels (20 - 40 mW). It. will also eliminate the need for a number of double- 
precision computations, which will reduce the required computation time. 

The tracking algorithm must employ some form of gradient computation to 
operate accurately at both long and short ranges. However, many redundant 
gradient computations in the developmental algorithm of Chapter 4 can be 
eliminated. The developmental algorithm uses numerical techniques to compute 
all gradients. Additional reductions in computation time may be possible by 
computing some or all of the gradients analytically. Redesign of the track- 
ing algorithm is therefore highly recommended. 

The accuracy of the roll estimate depends directly upon the accuracy 
with which signal amplitude can be measured. Antenna characteri sties that 
affect pattern ripple and variability should therefore be investigated fur- 
ther. If the cone of operation in which precise roll measurements are neces- 
sary can be limited to less than 45° from boresight, the antenna problem will 
become much less difficult. The actual requirements for roll accuracy should 
therefore be reviewed carefully. 

The simple simulation done as part of this study involved only static 
spacecraft. In contrast, a real rendezvous-and-docking operation involves 
various combinations of spacecraft dynamics. It also may include signal 
outages, antenna-pattern ripple at particular relative attitudes, and other 
effects. The final step in the evaluation of the feasibility of the polar- 
ized-interfereometer system is therefore dynamic simulation from acquisition 
to docking. 
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OR' 3^1 FACE 
OF FC Q 'Y 


PROGRAM LISTINGS 


Initialization A1 gorithm 

C Program # FHR-289-, 12/10/82 

C initialization algorithm for polarized Interferometer 
C 

C Declarations and constants 
C 

IMPLICIT LOGICAL (L) 

DIMENSION A1C3). A2(3>, A3<3), PI (3) , P2!3), P3(3), 

> A(3,3), AT(3,3), VEC1 (3) , VEC2C3), R(3,3), AHATC3.3), 

> C(3,3) 

WRITE(3»10) 

10 FORMAT ( • Initialization algorithm for polarized inter*, 

> ‘ferometer. Program I FHT—289-' ,/) 

DR =0.01 7453293 

C 

C Get true parameters 
C 

100 WRITE! 3, 1 10) 

110 FORMAT!' True position (rho.alphal ,beta1* = ') 

CALL ATR(RHO, 1 ERR) 

IF! IERR.EQ.27) GO TO 100 
CALL ATR! ALPHA 1,1 ERR) 

IF! I ERR.EQ.27) GO TO 100 

I F( ( ALPHA1 ,GT.90.0).OR.( ALPHA1 .LT.-90.0) ) GO TO 100 
CALL ATR (BET A 1,1 ERR) 

I F! IERR.EQ.27) GO TO 100 
ALPHA! =ALPHA1*DR 
BETA1 =8ETA1*DR 
WRI TE( 3, 120) 

120 FORMAT!' True attitude (psiz, psly, pslx) = ') 

CALL ATR(PSI Z, I ERR) 

IF! I ERR.EQ.27) GO TO 100 
CALL ATR(PSIY.IERR) 

IF! IERR.EQ.27) GO TO 100 
CALL ATR(PSIX,IERR) 

IF! I ERR.EQ.27) GO TO 100 
PSI Z=PSI Z*DR 
PSI Y=PSIY*DR 
PSI X=PSI X*DR 
C 

C Calculate position In rectangular coordinates and attitude matrix 
C 

CALL PRC {RHO, ALPHA 1 ,BETA1 ,VEC1 ) 

CALL ACOMPIPSI Z,PSI Y,PSI X,A) 

CALL TRANS! 3, 3, A, AT) 

C* WRITE! 3, 200) 

C* 200 FORMAT!/,' Position vector = ') 

C* CALL MWRI TE(3, 1 ,3,VEC1 ) 

C* WRITE! 3,210) 

C* 210 FORMAT!' Attitude matrix » ') 

C* CALL MWRITE(3,3,3,A) 

C 

C Calculate locations of antenna elements 
C 

CALL PATHES(VEC1 ,AT,R) 

C 

C Calculate coupling between linearly polarized elements 
CALL COUPLE! ALPHA! ,BETA1 ,AT,C) 

C* WRITE(3,220) 

C* 220 FORMAT!/,' C * ') 

C* CALL MWR|TE!3,3,3,C) 

C 

C Estimate range 
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c 

CALL ERANGECR, RHOHAT) 

WRI TEC 3,400) RHOHAT 
400 FORMATC/,' Rhohat » »,G15.8) 

C 

C DF at active array 
C 

CALL DFACTC RHOHAT, R,ALPH1H,BETA1H) 

ALPH1D-ALPH1H/DR 
BETA1D-8ETA1H/DR 
WRITEC3,500) ALPH1D, BETA1D 

500 FORMATC/,* Alphalhat - *,G15.8,' Betalhat - *,G15.8) 

C 

C DF at passive array 
C 

CALL DFP AS ( RHOHAT, R,ALPH2H, BET A2H) 

ALPH2D-ALPH2H/DR 
BETA2D*BET A2H/DR 
MR I TEC 3,600) ALPH2D, BETA2D 

600 FORMATC/,' Alpha2hat - *,GI5.8,' Beta2hat - *,G15.8) 

C 

C Rol I angle 
C 

CALL ESTROLCC,ALPH1H,BETA1H,PSIRH) 

PSIRD-PSIRH/DR 
WRITEC3.700) PSIRO 
700 FORMATC/,' Pslrhat - '.GI5.8) 

C Assemble attitude matrix 

CALL A2Cm>( ALPH1 H,B£TA 1 H ,PS I RH ,BETA2H , ALPH2H , AHAT) 

C* WRITEC3,900) 

C* 900 FORMATC/,' Ahat = •) 

C* CALL MWRI TEC 3 ,3 ,3 ,AHAT) 

C 

C Determine one-way Euler angles 

CALL EULERC AHAT,PSl2H,PSI YH,PSIXH) 

PSIZD-PSIZH/DR 
PSI YD*PSl YH/DR 
PSIXD-PSIXH/DR 

WRITE(3,1000) PSI ZD, PSI YD, PSIXD 
1000 FORMATC/,' Estimated one-way Euler angles:',/,' Pslzh 
> F10.3,/,' Pslyh - ' ,F10.3,/,' Psixh - *,F10.3) 

C 

WRI TEC 3,9000) 

9000 FORMATC/,' Continue ? ') 

READC3.9010) LCHR 
9010 FORMATC A1) 

LCHR«LCHR.AND.95 
IFCLCHR.E0.89) GO TO 100 
STOP 
END 


SUBROUTINE ACOff>(PSIZ,PSIY,PSIX,A) 

C Attitude matrix from Euler angles. 

C This matrix rotates coordinate frames, not vectors. 

C To rotate vectors within a coordinate frame, multiply by 
DIMENSION AC3.3) 

COSZ * COSCPSIZ) 

COSY * COSCPSIY) 

cosx - coscpsix) 

SINZ - SINCPSIZ) 

SINY ■ SINCPSIY) 

SINX - SINCPSIX) 


AC 1 , 1 ) 

S 

COSY 

» 

COSZ 







AC 1,2) 

m 

COSY 

* 

SINZ 







AC 1 ,3) 

a 

-SINY 









AC2.1) 

a 

-COSX 

# 

SINZ 

+ 

SINX 

ft 

SINY 

ft 

COSZ 

A ( 2 , 2) 

a 

COSX 

« 

COSZ 

+ 

SINX 

ft 

SINY 

ft 

SINZ 

AC 2 ,3) 

m 

SINX 

• 

COSY 







AC3, 1 ) 

a 

SINX 

« 

SINZ 

■f 

COSX 

ft 

SINY 

ft 

COSZ 

A(3,2) 

a 

■SINX 

• 

COSZ 

+ 

COSX 

ft 

SINY 

ft 

SINZ 


l-transpose. 
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A(3,3) - cosx * COSY -.v)OR OUAUTY, 

RETURN ' 

ENO 


SUBROUTINE PRC ( RHO, ALPHA, BETA, V EC) 

C Pol ar-to-rectangu lar coordinate converter 
C Produces unit vector with RH0»1 .0 
DIMENSION VEC(3) 

COSB=COS(BETA) * RHO 
VECC1)*X)SB * COS( ALPHA) 

VEC(2)*COSB * SI N( ALPHA) 

VEC(3) =-SI N(BETA) * RHO 

RETURN 

END 


FUNCTION RANGEL U,V) 

C Distance between points 
DIMENSION U(3) , V(3) 

RANGE-0. 0 
DO 10 J=1 ,3 

RANGE-RANGE + (V(J) - U( J))**2 
10 CONTINUE 

RANGE=SQRT( RANGE) 

RETURN 

END 


SUBROUTINE PATHESLVECI ,AT,R) 

C Compute 9 path lengths 

DIMENSION VECK3), VEC2L3) , ATL3.3), A1(3), A2(3), A3<3), 

> PI (3) , P2(3), P3(3), R(3,3), A0(3) 

C Active array in active-array coordinates 
A0( 1 ) =0.0 
A0(2) =0.0 
A0( 3) =0.0 
A1 ( 1 ) =0.0 
A1 (2) =0.0 
A1 (3) =- 1 .0 
A2C 1 ) =0.0 
A2(2) =-0.8660254 
A2(3) =0.5 
A3( 1 ) =0.0 
A3C2) =0.8660254 
A3<3) =0.5 

C Passive array in passive-array coordinates 
PH 1)=0.0 
PI (2) =0.0 
PI (3) =- 1 .0 
P2( 1 ) =0.0 
P2< 2) =-0.8660254 
P2(3) =0.5 
P3( 1 ) =0.0 
P3< 2) =0.8660254 
P3(3) =0.5 

C Rotate passive array by true attitude 
CALL SMULT(1,3,P1,1.0,VEC2) 

CALL MVMLT(3,3,1,AT,VEC2,P1) 

CALL SMULTL 1 ,3,P2, 1 .0, VEC2) 

CALL MVMLT(3,3,1,AT,VEC2,P2) 

CALL SMULTL 1,3,P3,I.0,VEC2) 

CALL MVMLT(3,3,1,AT,VEC2,P3> 

C* WRITE (3, 22 5) 

C* 225 FORMAT!/,' Rotated p vectors: ') 

C* CALL MWRITEL3, 1 ,3, PI ) 

C» CAlL MWRI TE(3, 1 ,3,P2) 

C* CALL MWRITE(3,1,i,°3) 

C Translate passive array by true position (convert to act-array coord) 
CALL MADD<3, 1 ,P‘. ,VECI ,P! ) 

CALL MADD( 3, 1 ,P2,VEC1 ,P2) 
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CALL MADD(3, 1 ,P3,VEC1 ,P3) 

C* WRITE(3,226) 

C # 226 FORMAT ( / * * Translated p vectors: ' ) 

C* CALL MWRI TEC 3,1 ,3,P1 ) 

C* CALL MWRITE(3,1,3,P2) 

C* CALL MWRI TE(3, 1 ,3,P3) 

C Calculate path lenghts - assume zero delay In passive transponder 
RHO00<WRANGE(A0,VEC1) 

R( 1, 1) GRANGE! A1, PI) + RHO00 
R( 1 ,2) -RANGE! A1 ,P2) + RHO00 
R! 1,3) GRANGE! A1.P3) + RHO00 
R( 2,1) GRANGE! A2,P1) + RHO00 
R(2,2) GRANGE! A2,P2) + RHO00 
R(2,3) GRANGE! A2,P3) + RHO00 
R(3,1) GRANGE! A3, PI ) + RHO00 
R(3,2)*RANGE(A3,P2) + RHO00 
R( 3,3) «4RANGE(A3,P3) + RHO00 
C # WRITE! 3,230) 

C* 230 FORMAT!/,' R * ' ) 

C* CALL MWRI TE(3, 3,3, R) 

RETURN 

Ei'ND 


SUBROUTINE ERANGE! R,RHOHAT) 
C Estimates A0-P0 range (rho00) 
DIMENSION R! 3,3) 

RHOHAT ^1.0 

DO 20 1*1,3 

DO 10 J*1 ,3 

RHOHAT ^RHOHAT + R(I,J) 

10 CONTINUE 
20 CONTINUE 

RHOHAT *RHOH AT / 1 8 . 0 

RETURN 

END 


SUBROUTINE DFACT!RHOHAT,R,ALPH1H,BETA1H) 

C Estimates alphal and betal 
C -1.57 <« alphalhat <» + 1.57 
C -1.57 <■ betalha 1- <• +1.57 

DIMENSION R( 3 ,3) , SA(3), RHO0(3) 

RA*1 .0 

Cl -1.7320508 * RA 
CI-3.0 * RA 

C Compite rho1,0, rho2,0, and rho3,0 
DO 20 J-1,3 
RHO0(J)*0.0 
DO 10 1-1,3 

RHO0! J)*RHO0(J) + R! J, I ) 

10 CONTINUE 

RHO0! J)*(RHO0( J)/3.0) - RhOHAT 
20 CONTINUE 

C Determine elements of unit vector pointing to passive array 
SA(2)-(RHO0I2) - RHO0(3))/C1 
S A ( 3 ) *( 2 ,0*RHO0 ! 1 ) - RHO0! 2) - RHO0(3))/C2 
SA( 1 ) -1 .0 - ( SA(2) ) # *2 - (SA<3))**2 
I F( SA( 1 ) .LT.0.0) SA(1)^.0 
SA( 1 ) -SQRT! SA( 1 ) ) 

C* WRITE! 3,30) 

C* 30 FORMAT!/,' SA ■ ' ) 

C* CALL MWRITE(3,1 ,3,SA) 

C Determine direction angles 
BETA1H--ASI N( SA(3> ) 

ALPH1H-ATAN2! SA! 2) ,SA( 1 ) ) 

RETURN 

END 


SUBROUTINE D FP AS! RHOHAT, R, ALP H2H, BET A2H) 
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C Estimates alpha2 and beta2 
C alpha2hat >■ tl.57 or <■ -1.57 
C -1.57 <■ beta2hat <- tl.57 

DIMENSION R(3,3) , SP(3), RHO0C3) 

PI -3.1415927 
TWOP I -6.2831853 
RP-1 .0 

Cl -1.7320508 * RP 
C2-3.0 * RP 

C Compute rf 1,0, rho2,0, and rho3,0 
DO 20 J-1,3 
RHO0(J)^.0 
DO 10 1-1,3 

RHO0(J)-«HO0(J) t R( I , J ) 

10 CONTINUE 

RHO0(J)-(RHO0(J)/3.0> - RHOHAT 
20 CONTINUE 

C Determine elements of unit vector pointing to passive array 
SP(2)-<RHO0(2) - RHO0<3) )/C1 
SP(3) -(2.0*RHO0( 1) - RHO0(2) - RHO0(3))/C2 
SP< 1 ) -1 .0 - (SP(2))**2 - (SP(3))**2 
I F(SP( D.LT.0.0) SP(1)^J.0 
SP( 1 ) —SQRT ( SP( 1 ) ) 

C* WRITE<3,30) 

C* 30 FORMATC/,' SP - 1 ) 

C» CALL MWRITE(3, 1 ,3,SP) 

C Determine direction angles 
BETA2H— ASIN(SP(3)) 

ALPH2H»ATAN2(SP(2),-SP(D) 

ALPH2H-PI-ALPH2H 

I F(ALPH2H.GT.PI ) ALP H2H-ALPH2H- TWOP I 

RETURN 

END 


SUBROUTINE EULER(A,PSIZ,PSir,PSIX) 

C Determines Euler attitude angles for given attitude matrix A 
C Conmon gain errors are eliminated by using ratios 
C As formulated, will not work with Psly * t-90* 

DIMENSION A(3,3) 

PSI Z-ATAN21 A( 1,2),A(l,t)) 

PSI X-ATAN21 A(2,3) , A(3,3) ) 

COSY=(A(1,1)*COS(PSIZ) t A( 1 ,2)*SI N(PSI Z) 

> t A(2,3)*SIN(PSIX) t A( 3,3) *COS( PSIX) )/2.0 
PSI Y-ATAN(-A( 1 ,3)/C0SY) 

RETURN 

Eh® 


SUBROUTINE A2C0MP( ALPHA! ,BETA1 ,PSIR,BETA2,ALPHA2,A) 
C Computation of attitude matr'x from two-way parameters 
DIMENSION A(3,3) , B(3,3), C(3,3), D(3,3) 

PI =3.1415926 

CALL ACOMPI ALPHA2-PI ,-BETA2,0.0,A) 

CALL TRAN$(3,3,A,B> 

CALL AC0MP(ALPHA1 ,BETA1,PSIR,C) 

CALL MVMLT(3,3,3,B,C,A) 

RETURN 

END 


SUBROUTINE COUPLEC ALPHA, BETA, AT, C) 

C Coupling between linearly polarized elements 
C Unity gain assumed 

C Columns of C correspond to received vectors for x, y, z dipole xmtr 
DIMENSION AT(3,3) , C<3.3), D(3,3), F(3,3) 

DO 20 J-1,3 
DO 10 1-1,3 
F(l,J)=<J.0 
10 CONTINUE 
20 CONTINUE 
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F(2,2)-1.0 
F (3,3) "1 .0 

CALL ACOMP(ALPHA,BETA,0.0,D) 

CALL MVMLT(3,3,3,D,AT,C) 

CALL MVMLT(3,3,3,F,C,D) 

C* WR|TE(3,50) 

C # 50 FORMATt/,' Coupling in tracking-frame ■ ') 
C* CALL MWRITE(3,3,3,D) 

CALL ACOKP(ALP:iA,8ETA,0.0,C) 

CALL TRANS(3,3,C,F) 

CALL MVMLT(3,3,3,F,D,C) 

RETURN 

END 


SUBROUTINE ESTR0L(C,ALPHA1 ,BETA1 ,PSIR) 

C Estimate relative-roll angle 
DIMENSION C(3,3) 

VZ0-C(3,3)/COS(BETA1) 

VY0-CC(2,3) - VZ0 * SIN(BETAI) * SI N( ALPHA1 ) )/C0S(ALPHA1 ) 
C* WRI TE( 3,20) VY0.VZ0 
C* 20 FORMATt/,' VY0, VZ0 « ' ,2G12.4) 

PSI R-ATAN2(-VY0,VZ0) 

RETURN 

END 


Simulation Program 


Program # FHR-321C, 06/27/83 
Simulation of polarized interferometer 

Declarations and constants 

IMPLICIT LOGICAL (L) 

DOUBLE PRECISION RRC3,3), RHO, RHOHAT, RHOHT , ORANGE, 

> Xl(3), XIHATC3), ETA(3) , ETAHAT(3), AA(3,3), DPC, DPI, 

> RTHAT(3,3) , RHO00 

DIMENSION A{3,3) , AT(3,3), VEC1 (3) , VEC2C3) , R(3,3), AHAT(3,3), 

> C(3,3), CHAT(3,3), ATHATC3.3), YC(4), VEC3(3) 

WRITE(3, 10) 

10 FORMAT ( ' Simulation of polarized Interferometer,', 

> ' Program # FHR-321C' ,/) 

DR-0.017453293 

DP1-1.0D+00 

Get true parameters 

100 WR I TE (3,1 10) 

110 FORMATC True parameters:') 

CALL GETPA( RHO, ALPHA 1 , BETA) , PSI Z, PSI Y, PSI X) 

PSIZD-PSIZ/DR 
PSI YD-PSI Y/DR 
PSI XD-PSI X/DR 
ALPH1D-ALPHA1/DR 
BETA1D-BETA1/DR 

RF parameters 

WRI TE( 3, 130) 

130 FORMATt/,' PF, PR - ' ) 

CALL ATRCPF, I ERR) 

CALL ATRtPR, I ERR) 

Test parameters 

WRITEC3, 140) 

140 FORMATC Number of tests. Iterations - ') 

CALL ATI (NTEST, I ERR) 

CALL AT I ( N I TMAX , I ERR ) 
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WRI TE(3, 150) 

150 FORMAT ( ' Seeds « *) 
CALL ATI ( IR1 , 1 ERR) 
CALL ATI ( IR2, 1 ERR) 
CALL F0PEN0!6,IERR) 


Calculate true position vector and attitude matrix 

CALL INITPA(RH0,ALPHA1,BETA1,PSIZ,PSIY,PSIX, 

> A, XI ,ETA,PSIR) 

CALL TRANS(3,3,A,AT) 

CALL DSMC(3,1,XI,VEC1) 


Calculate true locations of antenna elements 
CALL PATH2(RHO,XI,AT,RHO00,RR) 


Calculate true amplitude coupling between linearly polarized elements 
CALL C0UPLE!ALPHA1,BETA1,AT,C) 

CALL CYXFER!C,YC) 


Calculate position of active array w.r.t. passive array 

CALL SDMC(3,3,A,AA) 

CALL DMVMLT(3,3,1 ,AA,XI ,ETA) 

DPC— 1 .0D+00 

CALL DSMULT(3, 1 , ETA, DPC, ETA) 

CALL DSMC(3,1,ETA,VEC2) 

CALL RPC ( V EC2 , RHOS , ALPHA2 , BETA2 ) 

CALL ESTROLfC, ALPHA 1 ,BETA1 ,P$IR) 

ALPH2D*ALPHA2/0R 

BETA2D*BETA2/DR 

PSIRD=PSIR/DR 


Initialize frequency set 
CALL FCOMP 


Headings for output file 
WRi TE(6, 10) 

WRITE!6,200) RHO, ALPH10, BETA1D 
200 FORMAT!/, ' Rho = ',F!0.3,' Alpha! * ',F10.3, 

> ' Betal = * , F 10.3) 

WRI TE( 6,2101 PSI 2D, PSIYD, PSIXD 
210 FORMAT!' Psiz =» ', F10.3,' Psiy - ',F10.3, 

> ' Pslx - \F10.3) 

WRITE (6, 220) ALPH2D, BETA2D, PSIRD 
220 FORMAT!' Alpha2 = ' , F 10.3, ' Beta2 ■ '.F10.3, 

> ' Psir « 1 ,F10,3) 

WRITE (6, 230) PF, PR 

230 FORMAT!/,' PF « ' ,F 10.4 , * PR » ’ ,F 10.4) 

WRITE! 6, 240) NITMAX 

240 FORMAT!' Number of Iterations * ',15) 

WRITE! 6, 250) IR1, IR2 
250 FORMAT!' Seeds « ' ,218) 

WRI TE<6,260) 

260 FORMAT!/' TEST' ,9X,* el ' , 13X ,' e2* , 13X ,' e3 f , 13X ,' e4' , 

> 9X,' Nar ' ,/) 

2ero averages 

E1AVG-0.0 

E2AVG-0.0 

E3AVG*0.0 

E4AVG«0.0 

NART-0 

NS AMP *0 


Begin test 
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DO 5000 NT-1, NTEST 
CALL INTRPT(LINT) 

I F(LI NT . EQ.27) GO TO 4000 
C 

C Initial I z* estimates to true values 
C 

RHOHAT-RHO 

CALL 0SMULT<3, 1 ,XI ,DP1 ,X IHAT) 

CALL DSMULT!3,1,ETA,DP1, ETAHAT) 

PSIRH*>SIR 

CALL SMULT(3,3,A,1.0,AHAT) 

E1-0.0 
E2-0.0 
E3 H>.0 
E4-0.0 

C 

C RF SIMULATION 
C 

CALL RF ( RHO00 ,RR,PF,PR, RTHAT ,C ,CHAT , I R 1 , I R2 ) 

CALL CYXFER(CHAT,YC) 

WRITE(3,7001 ) 

7001 FORMAT!/, • RTHAT - «) 

DO 7003 1-1,3 

WRITE!3,7002) CRTHAT(I.J), J-1,3) 

7002 FORMAT { ' » ,3615.8) 

7003 CONTINUE 
WRlTE(3,7220) 

7220 FORMAT!/,' C - 

CALL MWRITE!3,3,3,C) 

WRI TE( 3,7221 ) 

7221 FORMAT!/, ' CHAT - ') 

CALL MWRI TE(3,3,3,CHAT) 

C 

C Check for ambiguity-resolution errors 
C 

NAR4J.0 

C Select ambiguity wavelength 
EMAX-0,12 

I F(RHO00.LT .0.9990+06) EMAX-0.72 
WRI TE(3, 1240) EMAX 
1240 FORMAT!' Emax « ',G12.4) 

DO 1280 1-1,3 
DO 1270 J-1,3 

ERR - ABSi SNGL! RR!I,J) + RHO00 - RTHAT! I , J J ) ) 
WRITE(3, 1250) I , J, RRII.J), RTHAT ( I , J ) , ERR 
1250 FORMAT! 2 1 5, 3G1 5. 8) 

I F! ERR. GT,. EMAX) NAR-NAR+1 
1270 CONTINUE 
1 28(0 CONTINUE 

I FCNAR.NE.0) GO TO 4000 
C 

C POSITION AND ATTITUOE ESTIMATION 
C 

2000 NSAMP-NSAMP+1 

DO 3000 NIT-1, NITMAX 
WRI TE(3, 2400> NT, NIT 

2400 FORMAT!/,' Test ',15,' Iteration ',13) 

CALL I TER ! RTH AT , YC , RHOH AT , X I H AT , ETAH AT ,P S I RH , AH AT , 

> Dl,D2,D3,D4,V1,V2,V3,V4,ALP1HD,BET1F€,ALP2f€,BET2HD) 
C 

C Write out true values and results of Iteration 

C 

WRI TE( 3,29 10) NIT 

2910 FORMAT!//,' RESULTS OF ITERATION #',13,':') 

WRI TE!3, 2930) RHOHAT, ALP IK), BET 1 HD 
2930 FORMAT!' Rhohat » ', G15.8,' Alphalhat - »,F10.3, 

> ' Betalhat - ' ,F10.3) 

WR|TE(3,2940) ( X I HAT ( J ) , J-1,3) 

2940 FORMAT!' XI hat - \3G15.8) 

WRI TE(3, 2960) (ETAHAT! J), J-1,3) 

2960 FORMAT!' Etahat - ' ,3G1 5.8) 
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PSIRHD^SIRH/DR 
WR|TE<3,2960) PSIRHD 
2980 FORMAT!' Pslrhat ■ ', F10.3) 

C 

C End of Iteration 
C 

3000 CONTINUE 
C 

C End of test - evaluate error 
C 

C Range error 

El ■ ABS( SNGL! RHOHAT - RHO)) 

E1AVG - E1AVG + E1«»2 
C Direction 

E2-SNGL! DRANGEtXI ,XIHAT) ) 

E2AVG - E2AVG ♦ E2 ## 2 
C Reverse direction 

E3-SNGL! DRANGE! ETA, ET AH AT) ) 

E3AVG • E3AVG + E3*»2 
C Rol I 

E4 - ABS( AMOO( (PSI RH - PSIR) ,6.2831853) ) 
E4AVG ■ E4AVG + E4*»2 

C 

C Output results 
C 

C Ambiguity-resolution errors 
4000 NART-NART * NAR 

WRI TE(3, 4900) NT, El, E2, E3, E4, NAR 
WRI TE(6,4900) NT, El, E2, E3, E4, NAR 
4900 FORMAT! 1 • , I 5,4(3X,G12.4) ,3X, 15) 

5000 CONTINUE 
C 

C Compute average errors 

IF!NSAMP.E<J.0) GO TO 5010 
El AVG-SQRT! El AVG/NSAMP) 

E2AVG-SQRT! E2 AVG/NSAMP) 

E3AVG-SQRT( E3AVG/NSAMP) 

E4AVG-SQRT! E4 AVG/NSAMP) 

5010 WRITE(3,5020) E1AVG, E2AVG, E3AVG, E4AVG, NART 
WRI TE(6, 5020) E1AVG, E2AVG, E3AVG, E4AVG, NART 
5020 FORMAT!/, • Rms ' ,4!3X,G12.4) ,3X, 1 5) 
E2AVG-E2AVG / DR 
E3AVG-E3AVG / DR 
E4AVG-E4AVG / DR 
WRITE(3,5030) E2AVG.E3AVG.E4AVG 
WR|TE(6,5030) E2AVG.E3AVG.E4AVG 
5030 FORMAT!' Rms*' , 15X,3!3X,G12.4) ) 

WRITE(3,5040) NSAMP 
WRI TE(6, 5040) NSAMP 
5040 FORMAT! /,' Nsamp - »,I5) 

ENDFILE 6 
C 
C 

WRITE! 3,9000) 

9000 FORMAT!/,' Continue program? *) 

READ! 3,9010) LCHR 
9010 FORMAT! A 1) 

LCHR "LCHR. AND. 95 * 

1 F(LCHR.EQ.89) GO TO 100 

STOP 

END 
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SUBROUT I NE INI TP A! RHOHAT , ALPH 1 H ,BETA 1 H , P F | ZH ,PS I YH ,P S I XH , 

> AHAT,X IHAT,ETAHAT,PSI RH) 

DOUBLE PRECISION XIHAT!3), ETAHAT(3) , RHOHAT, DPC 
DIMENSION AHAT ! 3 , 3 ) , CHATI3.3), ATHAT(3,3) , DUM1(3), DUM2!3) 
RHOS-SNGL! RHOHAT) 

CALL PRC(RHOS,ALPH1H,BETA1H,DUM1 ) 

CALL SOMC(3, 1 ,DUM1 ,X IHAT) 

CALL ACOMPIPSIZH, PSI YH, PSI XH, AHAT) 
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CALL TRANS! 3, 3, AHAT, ATHAT) 

CALL MVMLT(3,3,1,AHAT,DUM1,DUM2> 

CALL SOMC < 3, 1,DUM2, ETAHAT) 

DPC-1.0D+00 

CALL DSMULT(3, 1 , ETAHAT, DPC, ETAHAT) 

CALL DN0RM(3,XIHAT) 

CALL DNORM! 3, ETAHAT) 

CALL COUPLE ( ALPH 1 H , BETA 1 H , ATH AT ,CH AT) 
CALL ESTROL ( CHAT , ALPH 1 H , BETA1 H ,P S I RH 1 ) 
RETURN 
END 


SUBROUTINE ITER!RR,YC,RH0HAT,XIHAT1 ,ETAH1 ,PSIRH1 ,AHAT, 

> D1 ,D2,D3,D4,V1 ,V2,V3,V4,ALPH1D,BETA1D,ALPH2D,BETA2D) 
DOUBLE PRECISION RR(3,3>, RHOHAT, 

> XIHATK3), XIHAT2(3) , ETAHK3), ETAH2C3) , DPC 
DIMENSION A(3,3), 

> AT<3,3), AHAT!3,3) , ATHAT<3,3), CXI (2,2) , CETA(2,2>, 

> YC(4), DUMt (3) 

DR-0.017453293 

C 

C Initial calculations 
C 

CALL TRANS! 3, 3, AHAT, ATHAT) 

C 

C Range 
C 

CALL MV LEKRR, RHOHAT) 

01-0.0 

V1-0.0 

WRITE(3, 100) RHOHAT 

100 FORMAT!/,' MVLE #1: Rhohat ■ *,G15.8) 

C 

C Adjust xlhat and etahat 
C 

C Direction of target vehicle 
C 

WRITE(3,401 ) 

401 FORMAT!/,' MVLE #2') 

CALL MV LE2 ( 1 , RHOHAT ,RR ,X I HAT 1 , ATHAT , X I HAT2 ,CX I ,D2) 
WRITE! 3,402) !XIHAT1(J), J-1,3), !XIHAT2!J), J-1,3) 

402 FORMAT!/,' XIHAT1/XIHAT2 -' ,/,3E20. 10,/,3E20. 10) 

C* WRITE(3,420) 

C* 420 FORMAT!/, » CXI - ») 

C* CALL MWRITE(3,2,2,CXI) 

V2-!CX 1(1,1) + CXI (2,2)) * 3.0 
WRITE! 3,430) D2 
430 FORMAT!/,' D2 ■ ',G12.4) 

C 

C Update estimate of xl 
Dpc*j .00+00 

CALL DSMULT(3,1,XIHAT2,DPC,XIHAT1) 

C 

C Direction of active vehicle 
C 

WRITE(3,401) 

C Calculate attitude and position of active w.r.t. passive 
CALL MV LE2 ( 2, RHOHAT, RR, ETAH 1 , ATHAT, ETAH2,CETA,D3) 
WRITE(3,510) (ETAHKJ), J-1,3), (ETAH2! J), J-1,3) 

510 FORMAT!/, » ETAHAT 1/ETAHAT2 -' ,/,3E20.10,/,3E20.10) 

C* WRITEI3.520) 

C* 520 FORMAT!/,' CETA - ') 

C* CALL MWRITE(3,2,2,CETA) 

V3-(CETA( 1,1) ♦ CETA(2,2) ) * 3.0 
WRITE(3,530) 03 
530 FORMAT!/,' 03 - *,G12.4) 

C 

C Update estimate of eta 
DPC-1.0D+00 

CALL 0SMULT(3, 1 ,ETAH2,DPC,ETAH1 ) 


A. 
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Estimate relative roll angle 


Or POop r\, . 



WRITE(3,600) 

600 FORMATS, • MVLE #3« ) 

CALL DSMC(3, 1 ,XIHAT1 ,DUM1 ) 

RH0S-SNGL( RHOHAT) 

CALL RPC(DUM1,RH0S,ALPH1H,BETA1H) 

CALL 0SMC(3,1,ETAH1,DUM1) 

CALL RPC2(DUM1,RHOS,ALPH2H,BETA2H) 

ALPH1D-ALPH1H/DR 

BETA1D-8ETA1H/DR 

ALPH2D-AIPH2H/DR 

BETA2D-8ETA2H/DR 

CALL MVLE3(YC,ALPH1H,BETA1H,ALPH2H,BETA2H,PSIRH1, 
> PSIRH2,V4,D4) 

PSIRD1-PSIRH1/DR 
PSIRD2*’SIRH2/DR 
WRITE (3,620) PSIRDI, PSIRD2 

620 FORMATt/,' Pslrhl - »,G12.4,» Pslrh2 • », G12.4) 
WR|TE( 3,630) V4, 04 

630 FORMATC V4 « ',G12.4,' 04 - 1 ,G12.4) 


Update attitude matrix and roll angle 

CALL A2COM>(ALPHIH,BETA1H,PSIRH2,BETA2H,ALPH2H,AHAT) 
PSIRH1-PSIRH2 


RETURN 

EfC 


SUBROUTINE MVLEKRR.RHOHAT) 

Range 

DOUBLE PRECISION RR(3,3), RHOHAT 

RHOHAT-0.0 

DO 20 I -1 , 3 

DO 10 J-1, 3 

RHOHAT -RHOHAT + RRCI.J) 

10 CONTINUE 
20 CONTINUE 

RHOHAT -RHOHAT / 18.0 

RETURN 

El® 


SUBROUTINE MVLE2(L,RH0,RIN,XIHAT1 ,AT ,X IHAT2 ,CX I ,RSSDI F) 
MVLE for direction angles 
Inputs 

RIN: range measurements 

CN: noise covariance 

X I HAT 1 ; old estimate 

AT: transpose of estimated attitude matrix 

RHO: range 

Outputs 

XIHAT2: new estimate 
CXI: estimate covariance 

RSSDIF: rss difference In estimates 
IMPLICIT LOGICAL (L) 

DOUBLE PRECISION RIN(3,3), R(3,3), RHAT<3,3), RHO, DPC, 

> Y(3), THAT ( 3) , DELTYY(3), X I HAT 1(3) , X|HAT2(3>, Al(3,3) 
DIMENSION CN I ( 3 , 3 ) , CXI(2,2>, 

> AT ( 3 , 3 ) , DELTAY(3), G(3,2), T(3,2), GT( 2,3) , 

> DUMK2.2), DUM2(2,2), 8(2,3), DUM3(3,3), DUM4(2,3), X(2) 

Invert measurement covariance matrix 
CALL MIDENT(3,CNI) 

Forward or reverse mode? 

1F(L.EQ.2) GO TO 10 
DPC-1 .0D+00 
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CALL DSMULT(3,3,RIN,DPC,R) 

GO TO 20 

10 CALL D TRANS (3»3,RIN,R) 

Form set of three differences 
20 CALL RYXFER(RHO,R,Y) 

Predict measurements and find dlffaranca v actor 
CALL PATH£S(RH0.XIHAT1,AT,RHAT) 

CALL RYXFER(RHO,RHAT,YHAT) 

OPC— 1.0D+00 

CALL DSMULTt 1 ,3,YHAT,DPC,YHAT) 

CALL DMADOt 1,3,Y,YHAT,DELTYY) 

CALL DSMC(1,3,DELTYY,DELTAY) 

Grad I ant matrix 

CALL GRA02<RH0,XIHAT1,AT,G) 

E r ror-covar lance matrix 

CALL MVMLT(3,3,2,CN1,G,T) 

CALL TRANS(3,2,G,GT) 

CALL MVMLT(2,3,2,GT,T,CXI) 

CALL INVERT(CX I ,2,DET,DUM1 ,DUM2) 

WRITE(3,38) DET 
38 FORMATt/,' DET - '.G12.4) 

B landing matrix 

CALL MVMLT( 2,3,3, GT,CNI ,DUM4) 

CALL MVMLT(2,2,3,CXI ,DUM4,B) 

Estimated error 

CALL MVMLT( 2,3, 1 ,B,DELTAY,X) 

Rss error 

CALL MVMLTt 1,2,1, X,X,RSSO IF) 
RSSOIF-SQRT(RSSDIF) 

Update estimate 

CALL IACOMP(-X(1>,-X<2),0.0,DUM3) 

CALL SDMC(3,3,DUM3.AI) 

CALL 0MVMLT(3,3, 1 ,AI ,XIHAT1 ,X IHAT2) 

CALL 0N0RM(3,XIHAT2) 

RETURN 

ENO 


SUBROUTINE GRAD2(RHO,XI 1 ,AT,G) 

Gradient of range measurements with respect to direction 
DOUBLE PRECISION RHO, R1<3,3), R2(3,3), Y1<3), Y2<3), 
> XI1(3), X 12(3) , AA I ( 3,3) , DPC 
DIMENSION AT ( 3 , 3 ) , GO, 2), AIC3.3) 

DELTAA-0.01 

Measurements at nominal location 
CALL PATHES(RHO,XI1,AT,R1) 

CALL RYXFER(RHO,R1 ,Y1 ) 

DPC— 1.0D+00 

CALL DSMULT( 3, 1 ,Y1 ,DPC,Y1 ) 

Gradient In alpha direction 

CALL I ACOMP(-OELTAA,0.0,0.0,Al) 

CALL SDMC(3,5,AI ,AAI ) 

CALL DMVMLT(3,3,1,AAI ,XI1,XI2> 

CALL DNORM(3,XI2) 

CALL PATHES(RH0,XI2,AT,R2) 

CALL RYXFER(RH0,R2,Y2) 

CALL OMAOO(9,1,Y1,Y2,Y2) 

DO 20 J»1, 3 
G(J,1)»Y2(J) / DELTAA 
20 CONTINUE 
C 
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Gradient In beta direction 

CALL IACOMP(0.0,-DELTAA,0.0,AI) 
CALL $OMC(3,3,AI,AAI) 

CALL 0MVMLT(3,3,1,AAI,XI1,XI2> 
CALL DN0RM(3,XI2) 

CALL PATHES(RH0,XI2,AT,R2) 

CALL RYXFER(WO,R2,Y2) 

CALL DMA00(9,1,Y1,Y2,Y2) 

DO 30 J»1, 3 
G(J,2)*Y2<J) / DELTAA 
30 CONTI WE 

RETURN 

END 


SUBROUT I NE MV LE3 ( Y , ALPHA 1 .BETA I , ALPHA2 ,BETA2 ,P S I RH 1 , 

> PSIRH2.VARP.ERP) 

MVLE for ralativa roll angla 
I nputs 

Y: coupling measurement 

CN: noise covariance 

ALPHA1 , BETA1.ALPI A2.BETA2: DOA angles 

PSIRH1: previous estimate of roll angle 
Outputs 

PSIRH2: updated estimate of roll angle 

VARP: estimate irlence 

ERP: magnitude of difference In estimates 

DIMENSION Y<4), CNK4.4), YHAT{4) , A<3,3), AT<3,3), 

> DELTAYC4), G(4), T<4), B<4), DUM3<4,4>, C(3,3) 

DATA PI, TMOPI /3. 1415926, 6.2631852/ 

Invert measurement covariance matrix 
CALL MIDENT(4,CNI ) 


Predict measurements and find difference vector 
CALL A2C0*P(ALPHA1 .BETA! ,PSIRH1 ,BETA2,ALPHA2,A) 
CALL TRANS(3,3,A,AT) 

CALL COUPLE( ALPHA 1 ,BETA1 ,AT,C) 

CALL CYXFEP(C.YHAT) 

CALL SMULT( 4,1, THAT,- 1.0,YHAT) 

CALL MADO(4,I,Y,YHAT,OELTAY) 


Gradient matrix 

CALL GRAD3C ALPHA 1 .BETA 1 ,P S I RH 1 ,BETA2 , ALPHA2 ,G ) 


Error-covar lance matr!/. 

CALL MVMLT(4,4,1,C^i,G,T) 
CALL MVMLT( 1,4,1 ,G,T,VARP) 
VARP-1 .0/VARP 


Blending matrix 

CALL MVMLT(1,4,4,G,CNI,B) 

CALL SMULT( 1,4, B, VARP, B) 

Estimated error 

CALL MVMLT1 1,4,1, B.DELTAY.X) 

Rss error 
ERP-ABS(X) 

C Update estimate 

PSIRH2-PSIRH1 ♦ X 

I F1PSIRH2.GT.PI ) P$IRH2*>SlRH2-T*0Pl 
IF(PSIRH2.LT.-PI) PSIRH2*>SIRH2+TV0PI 
RETURN 
EW 


SUBROUTINE GRAD3( ALPHA 1 ,BETA1 ,PSIR! ,BETA2,ALPHA2,G) 
C Gradient of coupling vector v.r.t. relative roll angle 
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01 MENS I ON GU), Y1(4), A(3,3), AT<3,3), C<3,3> 

DELTAA-0.01 
F-1 .0/DELTAA 

C Coupling at nominal attitude 

CALL A2C0*P(ALPHA1 ,BETA1 ,P$IR1 ,BETA2,ALPHA2,A) 

CALL TRANS (3, 3, A, AT) 

CALL C0UPLE< ALPHA1 ,BETAt ,AT ,C) 

CALL CYXFER(C,Y1) 

CALL SMULT(4,1,Y1,-1.0,Y1) 

C Coupling at Incremented attitude 
PSIR2^SIRI + DELTAA 

CALL A2C0MP( ALPHA1 ,BETA1 ,PSIR2,BETA2,ALPHA2,A) 

CALL TRANS(3,3,A,AT) 

CALL COUPLEf ALPHA* ,BETA1 ,AT,C) 

CALL CYXFERtC.G) 

C Grad I ent 

CALL MAOO(4,1,Y1,G,G> 

CALL SMULT(4,1,G,F,G) 

RETURN 

ENO 


SUBROUTINE GETPA( RHO, ALPHA 1 .BETA) ,PSI Z.PSI Y.PSI X) 

C Get position and attitude 
DOUBLE PRECISION RHO 
DR-0.0 17453293 

100 WR I TE (3,1 10) 

110 FORMAT!' Position (rho,al phal , betal ) * *) 

CALL ATR(RHOS.IERR) 

RHO-OBLE(RHOS) 

IF(IERR.E(?.27) GO TO 100 
CALL ATR( ALPHA 1 ,IERR) 

I F( IERR.EQ.27) GO TO 100 

IFUALPHAI GT.90.0).OR. (ALPHA1.LT .-90.0)) GO TO 100 
CALL ATR(BETAI.IERR) 

I F( IERR.EQ.27) GO TO 100 
ALPHA 1 -ALP HA1*DR 
BETA! -BETA 1*DR 
WRITE(3,120) 

120 FORMATC Attitude (pstz, psiy, psix) « *1 
CALL ATR(PSI Z, I ERR) 

I F< IERR.EQ.27) GO TO 100 
CALL ATRtPSI Y, I ERR) 

I F( IERR.EQ.27) GO TO 100 
CALL ATR(PSIXJERR) 

I F( IERR.EQ.27) GO TO 100 

PSI Z-PSI Z*DR 

PSI Y-PSI Y*DR 

PSIX^SIX^DR 

RETURN 

ENO 


SUBROUTINE ACOfPCPSIZ.PSIY.PSlX.A) 

C Attitude matrix from Euler angles. 

C This matrix rotates coordinate frames, not vectors. 

C To rotate vectors within a coordinate frame, multiply by A-transpose. 
DIMENSION A(3,3) 

COSZ - COS(PSIZ) 

COSY « COS(PSIY) 

COSX - COS(PSIX) 

SINZ * SIN(PSIZ) 

SINY - SIN(PSIY) 


SI NX - 

s 

N(PSIX) 








AC 1,1) 

X 

COSY 

ft 

COSZ 







At 1 ,2) 

* 

COSY 

ft 

SINZ 







A( 1 ,3) 

a 

-SINY 









At 2, 1 ) 

a 

-COSX 

ft 

SINZ 

+ 

SINX 

ft 

SINY 

ft 

COSZ 

At 2,2) 

a 

COSX 

ft 

COSZ 


SINX 

ft 

SINY 

ft 

SINZ 

A ( 2 , 3 ) 

* 

SINX 

ft 

COSY 







At 3 , 1 ) 

a 

SINX 

ft 

SINZ 

+ 

COSX 

ft 

SINY 

ft 

COSZ 
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A(3,2) « -SINX * COSZ + COSX • SINY * SINZ 

A(3,3) » COSX * COSY 

RETURN 

END 


FUNCTION RANGE(U,V) 

C Distance between points 

DOUBLE PRECISION RANGE, DSQRT, V 
DIMENSION U(3) , V(3) 
RANGE^.0D+00 
DO ill J«1,3 

RANGE^ANGE + (V(J) - U(J))**2 
10 CONTINUE 

RANGE »OSQRT( RANGE) 

RETURN 

END 


FUNCTION DRANGEIU, V) 

C Distance between points 

IMPLICIT DOUBLE PRECISION CA-H.O-Z) 
DIMENSION U(3) ,V(3) 

DRANGE-0.0D+00 
OO 10 J*1 ,3 

DRANGE=ORANGE + (V(J) - U(J))**2 
10 CONTINUE 

ORANGE-OSQRT ( ORANGE ) 

RETURN 

END 


SUBROUTINE PATHES(RH0,V£C1 ,AT,R) 

C Compute 9 path lengths 

DOUBLE PRECISION RHO00, R(3,3>, VECK3), RHO 
DIMENSION AT (3,3) 

Compute one-way lengths 

CALL PATH2(RHO,VEC1,AT,RHO00,R) 


Add pathes 

DO 20 1-1,3 
DO 10 J-1,3 

R(I,J) * R(I,J) + RHO00 
10 CONTINUE 
20 CONTINUE 
RETURN 
END 


SUBROUT 1 NE PATH2 ( RHO , VEC3 , AT , RHO00 , R ) 

Compute 9 path lengths 

DOUBLE PRECISION RHO00, R<3,3), VEC1 (3) , VEC3C3), 

> DPI (3), DP2(3>, DP3(3) , RANGE, RHO 
DIMENSION VeC2(3) , AT<3,3), Al(3), A2(3), A3(3), 

> PI (3) , P2(3), P3<3), A0(3) 

Convert direction vector to position vector 
CALL DSMULT(3,1,VEC3,RH0,VEC1> 


Active array In active-array coordinates 
A0I1HJ.0 
A0(2)-0.0 
A0<3HB.0 
AK1) 

A1 (2) *0.0 
Al(3> — 1.0 
A2( 1 ) =0.0 
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A2(2) -0.8660254 
A2(3) *0.5 
A3( 1)^.0 
A3 (2) -0.8660254 
A3C3>*.5 

C Pass I ve array In pass i vo-array coordinates 
P1(1)«0.0 
PI (2) ■0.0 
P1(3)— 1.0 
P2<1)^.0 
P2(2)— 0.8660254 
P2(3>^.5 
P3< 1)^.0 
P3(2) ^.8660254 
P3(3)«0.5 

C Rotate passive array by true attitude 
CALL SMULT(1,3,P1,1.0,VEC2> 

CALL MVMLT(3,3,1,AT,VEC2.P1) 

CALL SMULT(1,3,P2,1.0,VEC2) 

CALL MVMLT(3,3,1,AT,VEC2,P2) 

CALL SMULT(1,3,P3,1.0,VEC2> 

CALL MVMLT(3,3,1,AT,VEC2,P3) 

C Translate passive array by true position (convert to act-array coord) 
CALL SDMC(3,1,P1,DP1) 

CALL SDMCC3,1,P2,DP2> 

CALL S0MC(3,1,P3,DP3) 

CALL DMADDC3, 1 ,DP1 ,VEC1 ,DP1 ) 

CALL DMADO(3,1,DP2,VEC1,DP2) 

CALL DMAD0(3,1,DP3,VEC1,DP3> 

C Length of forward path 
RHO00«RANGE(A0,VEC1) 

C Lengthes of return pathes 
R(I,1)«RANGE(A1,DP1) 

R(1,2)«RANGE(A1,DP2) 

R(1,3)«*ANGE(A1,DP3) 

R(2,l)^ANGE(A2,OP1) 

R(2,2)«RANGE(A2,DP2) 

R(2,3)>*ANGE<A2,0P3) 

R(3,1)*RANGE(A3,DP1) 

R(3,2)-RANGE(A3,DP2) 

R(3,3)«*ANGE(A3,DP3) 

RETURN 

END 


SUBROUTINE EULER(A,PSIZ,PSIY,PSIX) 

C Determines Euler attitude angles tor given attitude matrix A 
C Common gain errors are eliminated by using ratios 
C As formulated, will not work with Psly * +-90* 

DIMENSION A(3,3) 

PSI Z-ATAN2( A(I ,2) , A( 1 , 1 ) ) 

PSIX*ATAN2(A<2,3) ,A(3,3) ) 

COSY*(A( 1 ,1)*C0S(PSIZ) t A(1,2)*SIN(PSIZ> 

> + A(2,3)*SIN(PSIX) t A(3,3)*COS(PSIX))/2.0 

PSI Y*ATAN(-A( 1 ,3)/C0SY) 

RETURN 

END 


SUBROUTINE A2C0MP( ALPHA1 ,BETA1 ,PSIR,BETA2,ALPHA2,A) 
C Computation of attitude matrix from two-way parameters 
DIMENSION A(3,3) , B(3,3), C(3,3), D(3,3> 

PI -3. 14 15926 

CALL AC0MP( ALPHA2-PI ,-BETA2,0.0,A) 

CALL TRANS(3,3,A,B) 

CALL ACOff* ( ALPHA 1 ,BETA1 ,PSIR,C) 

CALL MVMLT(3,3,3,B,C,A) 

RETURN 

END 
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SUBROUTINE COUPLE( ALPHA .BETA, AT, C) 

C Coupling between linearly polarized elements 
C Unity gain assumed 

C Columns of C correspond to received vectors for x, y, z dipole xmtr 
DIMENSION AT(3,3) , C(3,3), D<3,3), F(3,3) 

DO 20 J»1 ,3 
DO 10 1-1,3 
F( I ,J ) *0.0 
10 CONTINUE 
20 CONTINUE 
FC2, 23-1.0 
F(3,3) -1 .0 

CALL ACOFP(ALPHA,BETA,0.0,D> 

CALL MVMLT ( 3 ,3 ,3 ,D , AT ,C ) 

CALL MVMLT(3,3,3,F,C,D) 

CALL ACOMP( ALPHA .BETA, 0.0,0 
CALL TRANS (3, 3 ,C,F) 

CALL MVMLT(3,3,3,F,D,C) 

RETURN 

END 


SUBROUTINE t AC0MP(PSI2,PSI Y,PSIX,A) 

C Attitude matrix for Incremental rotations 
DIMENSION A(3,3) 

CALL MIDENT(3,A) 

A( 1 ,2) -PSI 2 
A(2, 1 ) =-PSI 2 
AC 1 ,3) — PSI Y 
A(3,1)=PSIY 
A ( 2 ,3 ) -PSIX 
A(3,23 — PSIX 
RETURN 
END 


SUBROUTINE SHUFL(RIN.R) 
DIMENSION Rl N( 9) , R(9) 
R( 1)-RIN( 1) 

R(2)^IN(4) 

R(3) =RI N( 7) 

R(4)-RIN(2) 

R(5)-RIN(5) 

R(6) -RIN(8) 

R(7)-RIN(3) 

R(8)^IN(6) 

R( 9 3 -Rl N(9) 

RETURN 

END 


SUBROUTI NE ESTROLCC, ALPHA 1 ,B2TA1 ,PSI R) 

C Estimate relative-roll angle 
DIMENSION C(3,3) 

VZ0=C(3,3)/COS(BETA1 ) 

VY0-(C(2,3) - VZ0 * SIN(BETAI) * S INC ALPHA 1 ) )/COS( ALPHA 1 ) 

PSI R-ATAN2C-VY0, VZ03 

RETURN 

END 


SUBROUTINE CYXFERCC.Y) 
DIMENSION C(3,3) ,Y(4) 
Y( 13^(2,23 
Y ( 2) -CC2.3) 

YC33 =C<3,2) 

Y(4) =C(3,3) 

RETURN 

END 
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SUBROUTINE RYXFER(RHO,R,Y> 

DOUBLE PRECISION RHO, R(3,3), Y(3) 
Y(1)**<1,1) + R( 1 ,2) + R< 1 ,3) - 6.0 * RHO 

Y(2)-«(2,1) + R(2,2) + R(2,3) - 6.0 * RHO 

Y(3)**(3,1) + R(3,2) + R(3,3) - 6.0 * RHO 

RETURN 
END 


ORIGINAL VMS Jj* 
OF POOR QUALITY 


SUBROUTINE RPC2(V,RH0,ALPHA,BETA) 

C Converts vector to polar coordinates 
C Smooth transition across alpha-180* 
DIMENSION V(3) 

DATA PI, TWOPI /3. 1415926, 6.2831852/ 
RHO-0.0 
DO 10 1-1, 3 
RHO -RHO + V{ I ) # *2 
10 CONTINUE 
RHO-SQRT(RHO) 

ALPHA-ATAN2( V(2) ,-V( 1 )) 

ALPHA-PI-ALPHA 

I F(ALPHA.GT.PI ) ALPHA-ALP HA- TWOP I 
BETA— ASIN(VC3)/RH0) 

RETURN 

END 


SUBROUTINE FCONP 

C Compute set of forward and reverse frequencies 

DOUBLE PRECISION F0, FF0, FR0, FF(9), FRO) , FD, 
> ANU, ANUK 

COMMON /FSET/ FF0, FR0, F0, FF, FR 


Basic frequency plan 

FF0 « 3.0D+09 
FR0 - 2.0D+09 
F0 - 1 .2500+03 
ANU * 6. 13240+00 

Forward and reverse frequencies 

FF( 1) • FF0 
FR( 1 ) « FR0 
ANUK - 1 .00+00 

DO 100 KK-2,9 
FD * F0 * ANUK 
FF(KK) « FF0 + FD 
FR(KK) - FR0 + FD 
ANUK ■ ANUK * ANU 
100 CONTINUE 
RETURN 
END 


SUBROUT I NE RF ( RHO00 ,RR,PF,PR ,RTHAT , AC , ACHAT , I R 1 , I R2 ) 
Simulation of RF subsystems 

DOUBLE PRECISION RR(3,3), RTHAT(3,3), PHI (3,3,9), TWOPI, 

> FF0, FR0, F0, FF(9) , FRO), RHO00, RHOCFT , PHIF, 

> DMOD, RH01 , RHO 2, RH03, RHO A, RHOHAT, C, DPI, DP2 
DIMENSION AC(3,3) , ACHAT(3,3) 

CONWON /FSET/ FF0, FR0, F0, FF, FR 
COMMON /AR/ PHI, TWOPI, C, DPI, DP2 
DATA TWOPI, C / 6.283 185308D+00, 3.0D+08 / 

DATA DPI, DP2 / 1.0D+00, 2.0D+00 / 

DATA RHOCFT / 1 .0D+06 / 

DATA GT, GR, FN, BK, T, B 

> /2.0, 2.0, 10.0, 1.38E-23, 300.0, 100.0/ 
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Cl?* 

OF 


Receiver noise 

PN-BK*T*0 # FN 
Phase shifts for each of nine carriers 
DO 100 N-1,9 
Forward- 1 ink 

PHI F ■ TWOPI / C * RHO00 * FF(N) 

PS - PF * GT * GR / PLOSS<RHO00,FF(N)> 

SIGMA « SQRTC0.5 * PN / PS) 

CALL GAUSS( IR1 ,IR2,0.0,SIGMA,DELPHI ) 

PHI F « PHIF ♦ DELPHI 

Reverse 1 1 nks 

DO 90 1-1,3 
DO 80 J-1,3 

PHI ( I , J ,N) - TWOPI / C * RR( I , J ) * FR(N) 

PS - PR * GT * GR / PLOSS(RR( I ,J) ,FR(N) ) 

SIGMA - SQRT<0.5 * PN / PS) 

CALL GAUSS! IR1 ,IR2 ,0.0, SIGMA, DELPHI ) 

PHI < I , J ,N) - TWOPI / C * RR(I,J> * FR(N) + PHIF + DELPHI 
Map phase Into (0,twopi) interval 
PHI ( I , J ,N) OMOOtPHI ( I , J ,N) , TWOPI ) 

80 CONTINUE 
90 CONTINUE 

100 CONTINUE 

Noise-Induced errors in normalized amplitude measurements 

DO 150 N-1,9 
SNR 

PS - PF * GT * GR / PLOSS ( RHO00 , FR ( N ) ) 

SIGMA - SQRT (0.5 * PN / PS) 

Average measurements at all nine frequencies 
CALL MZER0(3,3,ACHAT) 

DO 130 1-2,3 
DO 120 J-2,3 

CALL GAUSSOR1 ,IR2, 0.0, SIGMA, DELPHI) 

ACHAT ( I , J ) -ACHAT ( I , J ) + DELPHI 
120 CONTINUE 
130 CONTINUE 
150 CONTINUE 

CONST-0.1111111 

CALL SMULT (3,3, ACHAT .CONST , ACHAT ) 

Corrupt measurements 

CALL MADD(3,3,AC,ACHAT,ACHAT) 

Estimate nine round-trip ranges 

DO 700 1-1,3 
DO 690 J-1,3 
WRITE<3,290) I , J 
290 FORMAT(/,' I, J - » ,2 1 5) 


Estimate range from lowest difference frequency 

CALL ERD( I , J,2,RHOHAT,RhOA) 

WRt TE(3,300) RHOHAT 

300 FORMAT!/, • Dif / 2 Rhohat - '.G20.12) 

Estimate range from next-higher difference frequency 

DO 400 N « 3, 9 

CALL ERD( I ,J,N,RH02,RH0A) 

CALL AMBRES(RH0A,RH0HAT,RH02) 
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RHO * RHOA * PHI ( I , J ,N2) / TWOPt 

RETURN 

END 


SUBROUTINE AMBRES(RH0A,RH01 ,RH02) 

C Resolve cycle ambiguity 

DOUBLE PRECISION DMOO, RH01, RH02, RHOA, 
> DPI, DP2, DL, DLHAT 
C Estimate lane number 
DL ■ RH01 / RHOA 
DL « DL - DMOOCDL, 1 .00+00) 

DLOL - 4 .00+00 

EHAT - 1.0E+20 

DO 330 NL«1, 7 

DL « DL + 1 .0D+00 

I F(DL.LT .-0.5D+00) GO TO 315 

E ■ ABS( SNGLCRH02 + DL*RHOA - RH01) ) 

IF(E.GE.EHAT) GO TO 320 

DLHAT « DL 

EHAT-E 

320 CONTINUE 
315 CONTINUE 
330 CONTINUE 

RH01 « RH02 + DLHAT* RHOA 

RETURN 

END 
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